CN110618290B - Speed information fusion method - Google Patents
Speed information fusion method Download PDFInfo
- Publication number
- CN110618290B CN110618290B CN201910849531.0A CN201910849531A CN110618290B CN 110618290 B CN110618290 B CN 110618290B CN 201910849531 A CN201910849531 A CN 201910849531A CN 110618290 B CN110618290 B CN 110618290B
- Authority
- CN
- China
- Prior art keywords
- speed
- value
- channel
- information
- course
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01P—MEASURING LINEAR OR ANGULAR SPEED, ACCELERATION, DECELERATION, OR SHOCK; INDICATING PRESENCE, ABSENCE, OR DIRECTION, OF MOVEMENT
- G01P3/00—Measuring linear or angular speed; Measuring differences of linear or angular speeds
- G01P3/42—Devices characterised by the use of electric or magnetic means
- G01P3/50—Devices characterised by the use of electric or magnetic means for measuring linear speed
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06F—ELECTRIC DIGITAL DATA PROCESSING
- G06F17/00—Digital computing or data processing equipment or methods, specially adapted for specific functions
- G06F17/10—Complex mathematical operations
- G06F17/18—Complex mathematical operations for evaluating statistical data, e.g. average values, frequency distributions, probability functions, regression analysis
Abstract
The invention discloses a speed information fusion method, which comprises the following steps: 1) measuring point layout: a plurality of speed measuring points are triangularly arranged on the ship, and each speed measuring point is provided with a sensor and an amplifier; 2) data acquisition: acquiring speed information by using a sensor and an amplifier, and acquiring the rotating speed and the course of a stern shaft by using a navigation system; 3) data fusion: performing fusion calculation on the data acquired in the step 2) based on the ship navigation state to obtain the navigation speed of the ship; the ship navigation state is obtained by judging speed information, the rotating speed of a stern shaft and the course. The speed fusion method provided by the invention not only considers the reliability of the measured value, but also considers the influence of the running state of the ship on the speed measurement, so that the finally obtained speed is more accurate and stable.
Description
Technical Field
The invention relates to the technical field of large surface ship speed measurement, in particular to a speed information fusion method.
Background
The take-off and landing of the airplane of the large-sized water surface ship are basic operations, and the speed of the ship is a basic element when the airplane takes off and lands, so that the requirements on the real-time performance, accuracy and stability of the speed are high. The large-scale surface ship is big in ship type, and the bottom of the ship produces rich bubble layer when navigating, and the bubble layer is free at the bottom of the ship along with the change of ship speed, and it is undulant easily to test the speed, brings very big difficulty and challenge for real-time, accurate and stable speed measuring.
Therefore, how to improve the accuracy of speed measurement of large surface ships is a problem that needs to be solved urgently by those skilled in the art.
Disclosure of Invention
In view of the above, the invention provides a speed information fusion method, which improves the real-time performance, accuracy and stability of speed measurement of large surface ships.
In order to achieve the purpose, the invention adopts the following technical scheme:
a method of velocity information fusion, comprising:
1) measuring point layout: a plurality of speed measuring points are triangularly arranged on the ship, and each speed measuring point is provided with a sensor and an amplifier;
2) data acquisition: acquiring speed information by using a sensor and an amplifier, and acquiring the rotating speed and the course of a stern shaft by using a navigation system;
3) data fusion: performing fusion calculation on the data acquired in the step 2) based on the ship navigation state to obtain the navigation speed of the ship; the ship navigation state is obtained by judging speed information, the rotating speed of a stern shaft and the course.
Preferably, the speed measuring points comprise three.
Preferably, the fusion calculation includes the following specific steps: channel estimation, ship navigation state judgment, wild value elimination and multi-channel information fusion.
Preferably, the channel estimation method specifically comprises the following steps:
and counting the mean value and the variance of each speed information, the rotating speed of the stern shaft and the course information within the preset time according to the time sequence.
Preferably, the ship navigation state comprises four states of uniform speed direct navigation, variable speed direct navigation, rotation and anchoring;
the method for judging the uniform speed direct navigation specifically comprises the following steps:
s11: the course information is stable, and the difference value between the current course angle and the mean value of the course angle is within an allowable disturbance range;
s12: the rotation speed of the screw shaft is stable, and the difference value between the current rotation speed of the screw shaft and the mean value of the rotation speed of the screw shaft is in an allowable disturbance range;
s13: the absolute value of the difference value between the current measurement value and the speed average value of the three electromagnetic speed measurement points is smaller than a threshold value;
if S11 is true and one of S12 or S13 is true, the vehicle is determined to be in a uniform direct navigation state;
the method for judging the variable speed direct navigation specifically comprises the following steps:
s21: the course information is stable, and the difference value between the current course angle and the mean value of the course angle is within an allowable disturbance range;
s22: the rotating speed of the stern shaft changes, and the difference value between the current rotating speed of the stern shaft and the mean value of the rotating speed of the stern shaft is not in an allowable disturbance range;
s23: the absolute value of the difference value between the current measurement value and the speed average value of the three paths of electromagnetic speed measurement points is larger than a threshold value, and the symbols are the same;
if the three conditions of S21-S23 are met simultaneously, the state is judged to be a speed-changing straight-driving state;
the method for judging the gyratory navigation specifically comprises the following steps:
s31: changing course information, judging that the current course angle and the mean value of the course angle are in a gyrus state if the difference value of the current course angle and the mean value of the course angle is not in an allowed disturbance range for three times continuously and the signs are the same;
if one of S12 or S13 is satisfied, the rotation is determined to be constant speed rotation; if one of S22 or S23 is satisfied, the speed change is judged to be the speed change rotation, and whether the speed is accelerated or decelerated is judged according to the sign;
the method for judging the anchoring navigation state specifically comprises the following steps:
s41: the course information is stable, the difference value between the current course angle and the mean value of the course angle is within the allowable disturbance range for three times continuously, and the signs are the same;
s42: the rotating speed of the screw shaft is 0, the difference value between the current rotating speed of the screw shaft and the mean value of the rotating speed of the screw shaft is within an allowable disturbance range for three consecutive times, and the symbols are the same;
s43: the absolute values of the difference values between the current measurement values and the speed average values of the three electromagnetic speed measurement points are not larger than a threshold value, the signs are the same, and the speed average value of each speed channel is lower than 3 kn;
if the three conditions of S41-S43 are met simultaneously, the state is judged to be the anchoring navigation state;
and the course angle mean value, the stern shaft rotation speed mean value and the speed mean value are obtained through channel estimation.
Preferably, the specific method for wild value elimination includes:
the method for eliminating the wild value in the uniform speed direct navigation state comprises the following steps:
in a uniform-speed straight-ahead state, when the absolute value of the difference between the current measured value and the mean value of each speed channel is greater than a certain threshold within a certain continuous period of time, judging that the channel information is not credible, rejecting the signal, and adopting the previous observed value for each statistical characteristic of the channel;
the method for eliminating the wild value in the variable speed direct navigation state comprises the following steps:
in the variable speed navigation state, the course is stable, the absolute value of the difference between the current measured value and the mean value of the course channel in a certain period of time is greater than a certain threshold, the course channel information is judged to be unreliable and is removed, the course information is set as a default value, and the course information is reinitialized after the preset time is delayed;
the rotation speed of the stern shaft changes, the difference between the rotation speed of the stern shaft and the rotation speed change is larger than a certain threshold in a certain period of time, the rotation speed information of the stern shaft is judged to be unreliable and is rejected, the rotation speed of the stern shaft is set as a previous observed value, and the rotation speed information of the stern shaft is reinitialized after the preset time is delayed;
information change of electromagnetic speed measuring channel, speed information of each speed measuring channel in a certain period of time
Judging that the channel speed information is not credible and rejecting the channel speed information; wherein, amaxIs the maximum acceleration of the ship, sigma is the velocity variance,
for the velocity mean, the statistical properties of the channel adopt the previous observationMeasuring;
the method for rejecting the wild value in the gyratory navigation state is consistent with the method for judging and rejecting the wild value of the rotating speed of the electromagnetic channel and the screw shaft in the constant-speed and variable-speed navigation states; for course change, if the absolute value of the difference between the current measured value and the mean value of the course channel in a certain period of time is greater than a certain threshold, the course channel information is judged to be unreliable and is removed, or the course channel information is set as a default value under the condition that a fault value is unavailable, and the course information is reinitialized after a delay;
the outlier rejection method under the anchoring state is similar to the outlier rejection method of the uniform speed direct navigation, the course and the navigation speed both keep a certain constant, the rotating speed of the screw shaft is zero, the absolute value of the difference between the current measured value and the mean value of each channel in a certain period of time is greater than a certain threshold, the channel information is judged to be not credible, the signal is rejected, and each statistical characteristic of the channel adopts the previous observed value; for three electromagnetic channels, if the absolute value of the difference between the current measured value and the mean value is greater than a certain threshold, the current information of the channel is considered to be unreliable, the signal is rejected, and each statistical characteristic of the channel adopts the previous observed value.
Preferably, the fusion calculation includes the following specific steps:
calculating the confidence degree distance of each speed channel according to the speed information at different moments in preset time and a threshold value; wherein the threshold is equal to the sum of the velocity mean, the sensor accuracy value, and the velocity variance;
distributing a weight value to the speed channel based on the ship navigation state and the confidence degree distance;
and performing fusion calculation based on the weight value and the current speed information to obtain the navigational speed of the ship.
According to the technical scheme, compared with the prior art, the speed information fusion method provided by the invention not only considers the reliability of the measured value, but also considers the influence of the running state of the ship on the speed measurement, so that the finally obtained speed is more accurate and stable. In addition, the wild value is eliminated through channel estimation, the motion state of the ship is judged, speed fusion is carried out on the basis of the data after the wild value is eliminated and the motion state of the ship, the navigational speed of the ship is obtained, and the result is more accurate.
Drawings
In order to more clearly illustrate the embodiments of the present invention or the technical solutions in the prior art, the drawings used in the description of the embodiments or the prior art will be briefly described below, it is obvious that the drawings in the following description are only embodiments of the present invention, and for those skilled in the art, other drawings can be obtained according to the provided drawings without creative efforts.
Fig. 1 is a schematic flow chart of a speed information fusion method provided in the present invention;
fig. 2 is a schematic flow chart of a method for multi-channel information fusion provided by the present invention.
Detailed Description
The technical solutions in the embodiments of the present invention will be clearly and completely described below with reference to the drawings in the embodiments of the present invention, and it is obvious that the described embodiments are only a part of the embodiments of the present invention, and not all of the embodiments. All other embodiments, which can be derived by a person skilled in the art from the embodiments given herein without making any creative effort, shall fall within the protection scope of the present invention.
Referring to fig. 1, an embodiment of the present invention discloses a speed information fusion method, including:
1) measuring point layout: a plurality of speed measuring points are triangularly arranged on the ship, and each speed measuring point is provided with a sensor and an amplifier;
preferably, three speed measuring points are arranged on the ship in a triangular mode in consideration of the requirements of cost, calculation real-time performance and the like.
2) Data acquisition: acquiring speed information by using a sensor and an amplifier, and acquiring the rotating speed and the course of a stern shaft by using a navigation system;
3) data fusion: performing fusion calculation on the data acquired in the step 2) based on the ship navigation state to obtain the navigation speed of the ship; the ship navigation state is obtained by judging speed information, the rotating speed of a stern shaft and the course.
The speed fusion method provided by the invention not only considers the reliability of the measured value, but also considers the influence of the running state of the ship on the speed measurement, so that the finally obtained speed is more accurate and stable.
In order to further optimize the above technical solution, the specific steps of the fusion calculation include: channel estimation, ship navigation state judgment, wild value elimination and multi-channel information fusion.
Specifically, the channel estimation method specifically comprises the following steps:
and counting the mean value and the variance of each speed information, the rotating speed of the stern shaft and the course information within the preset time according to the time sequence.
When the ship state is judged and the wild value is eliminated, the mean value and the variance of each channel are considered.
The data fusion channel comprises two types, one type is used for estimating speed information and comprises 3 paths of electromagnetic sensor speed signals. One type is used for state judgment and comprises information of each speed estimation channel, the rotating speed of a screw shaft and course information.
The channel statistic for speed estimation is used for channel outlier rejection, channel speed estimation and auxiliary judgment of the constant speed, variable speed and anchoring navigation state of the ship body. Counting the mean value and variance of certain channel information in a period of time according to the time sequence, and adopting mathematical unbiased estimation, wherein the sampling point is about n points, and the calculation method is as follows:
using n-1 instead of n in the standard deviation estimation is mathematically an unbiased estimation.
And the channel statistics of the rotating speed and the course of the stern shaft are used for judging the current sailing state of the ship. The statistical method is consistent with the electromagnetic channel, and the sampling point is about m points.
Before processing the information of each channel, the current navigation state is judged, whether the information is credible or not is judged under the current navigation state, different weights are distributed, and the current speed of the channel is estimated. The different navigation states are judged so as to adopt different speed estimation algorithms aiming at the different navigation states, so that the best compromise between information stability and real-time performance is obtained. The navigation states related to the current scheme include four states of constant speed, variable speed, gyration and anchoring, and the determination method of each navigation state is described below.
The uniform speed navigation state is judged by the rotation speed and the course information of the stern shaft and the information of each speed channel. When the following conditions are met, judging that the large ship is in a uniform speed direct navigation state:
specifically, the method for judging the uniform speed direct navigation comprises the following steps:
s11: the course information is stable, and the difference value between the current course angle and the mean value of the course angle is within an allowable disturbance range; during specific implementation, the judgment standard is that the difference value of three continuous times is within the disturbance range;
s12: the rotation speed of the screw shaft is stable, and the difference value between the current rotation speed of the screw shaft and the mean value of the rotation speed of the screw shaft is in an allowable disturbance range; similarly, in specific implementation, the judgment criteria may be: the difference value of three consecutive times is in the disturbance range;
s13: the absolute value of the difference value between the current measurement value and the speed average value of the three electromagnetic speed measurement points is smaller than a threshold value; in specific implementation, the judgment criteria are as follows: the absolute value of the difference value between the current measurement value of the three paths of electromagnetic speed measurement points and the speed mean value is less than the threshold value twice;
if S11 is true and one of S12 or S13 is true, the vehicle is determined to be in a uniform direct navigation state;
the method for judging the variable speed direct navigation specifically comprises the following steps:
s21: the course information is stable, and the difference value between the current course angle and the mean value of the course angle is within an allowable disturbance range; in specific implementation, the judgment standard is that the difference value of three continuous times is out of the disturbance range;
s22: the rotating speed of the stern shaft changes, and the difference value between the current rotating speed of the stern shaft and the mean value of the rotating speed of the stern shaft is not in an allowable disturbance range; in specific implementation, the judgment standard is that the difference value of three continuous times is in a disturbance range, and the symbols are the same;
s23: the absolute value of the difference value between the current measurement value and the speed average value of the three paths of electromagnetic speed measurement points is larger than a threshold value, and the symbols are the same; in specific implementation, the judgment criteria are as follows: the absolute value of the difference value between the current measurement value of the three paths of electromagnetic speed measurement points and the speed mean value is larger than the threshold value and has the same sign;
if the three conditions of S21-S23 are met simultaneously, the state is judged to be a speed-changing straight-driving state;
the method for judging the gyratory navigation specifically comprises the following steps:
s31: changing course information, judging that the current course angle and the mean value of the course angle are in a gyrus state if the difference value of the current course angle and the mean value of the course angle is not in an allowed disturbance range for three times continuously and the signs are the same;
if one of S12 or S13 is satisfied, the rotation is determined to be constant speed rotation; if one of S22 or S23 is satisfied, the speed change is judged to be the speed change rotation, and whether the speed is accelerated or decelerated is judged according to the sign;
the method for judging the anchoring navigation state specifically comprises the following steps:
s41: the course information is stable, the difference value between the current course angle and the mean value of the course angle is within the allowable disturbance range for three times continuously, and the judgment standard is as follows: the difference values in the three consecutive times are within the disturbance range, and the signs are the same;
s42: the rotating speed of the stern shaft is 0, the difference value between the current rotating speed of the stern shaft and the mean value of the rotating speed of the stern shaft for three times in succession is in an allowable disturbance range, and the judgment standard is as follows: the difference values in the three consecutive times are within the disturbance range, and the signs are the same;
s43: the absolute values of the difference values between the current measurement values and the speed average values of the three electromagnetic speed measurement points are not larger than a threshold value, the signs are the same, and the speed average value of each speed channel is lower than 3 kn; the unit of the speed is section, which is equivalent to sea/h;
if the three conditions of S41-S43 are met simultaneously, the state is judged to be the anchoring navigation state;
and the course angle mean value, the stern shaft rotation speed mean value and the speed mean value are obtained through channel estimation.
The wild value elimination is divided into two cases, one is that a certain current measurement information is seriously deviated from a true value, and a current measurement point is eliminated, so that the estimation result is prevented from being influenced by the serious deviation of the current value from the true value; in another case, the channel information is always seriously deviated from the true value, in which case, the channel information needs to be rejected and then the channel is initialized after a certain time delay, so as to re-enable the channel information when possible.
Specifically, it is determined whether a certain channel or certain observation point data is a wild value related to the current navigation state, and different navigation states correspond to different determination methods, which will be separately described below.
The method for eliminating the wild value in the uniform speed direct navigation state comprises the following steps:
under the uniform speed straight-ahead state, the course, the rotating speed of a stern shaft and the navigational speed all keep a certain constant, when the absolute value of the difference between the current measured value and the mean value of each speed channel is greater than a certain threshold in a certain continuous period of time, the channel information is judged to be unreliable, the signal is removed, and each statistical characteristic of the channel adopts the previous observed value;
under the state of uniform speed straight-ahead driving, the absolute value of the difference between the current measured value and the mean value of a certain path of information at a certain continuous time is greater than a threshold, and the probability is that p is 0.00310＝6×10-26That is, normally, this situation may occur on average every 4.6 × 1020h, and therefore, it can be considered that, when this situation occurs, it is likely that the channel is failed, and the channel information should be rejected.
The method for eliminating the wild value in the variable speed direct navigation state comprises the following steps:
in the variable speed navigation state, the course is stable, the absolute value of the difference between the current measured value and the mean value of the course channel in a certain period of time is greater than a certain threshold, the course channel information is judged to be unreliable and is removed, the course information is set as a default value, and the course information is reinitialized after the preset time is delayed;
the rotation speed of the stern shaft changes, the difference between the rotation speed of the stern shaft and the rotation speed change is larger than a certain threshold in a certain period of time, the rotation speed information of the stern shaft is judged to be unreliable and is rejected, the rotation speed of the stern shaft is set as a previous observed value, and the rotation speed information of the stern shaft is reinitialized after the preset time is delayed;
information change of electromagnetic speed measuring channel, speed information of each speed measuring channel in a certain period of time
Judging that the channel speed information is not credible and rejecting the channel speed information; wherein, amaxIs the maximum acceleration of the ship, sigma is the velocity variance,
taking the average speed value, and adopting the previous observed value for each statistical characteristic of the channel;
the method for rejecting the wild value in the gyratory navigation state is consistent with the method for judging and rejecting the wild value of the rotating speed of the electromagnetic channel and the screw shaft in the constant-speed and variable-speed navigation states; corresponding judgment methods are adopted for the rotation speed information of the electromagnetic channel and the screw shaft under the two states of constant speed rotation and variable speed rotation, but the course information should be treated differently. For course change, if the absolute value of the difference between the current measured value and the mean value of the course channel in a certain period of time is greater than a certain threshold, the course channel information is judged to be unreliable and is removed, or the course channel information is set as a default value under the condition that a fault value is unavailable, and the course information is reinitialized after a delay;
the outlier rejection method under the anchoring state is similar to the outlier rejection method of the uniform speed direct navigation, the course and the navigation speed both keep a certain constant, the rotating speed of the screw shaft is zero, the absolute value of the difference between the current measured value and the mean value of each channel in a certain period of time is greater than a certain threshold, the channel information is judged to be not credible, the signal is rejected, and each statistical characteristic of the channel adopts the previous observed value; for three electromagnetic channels, if the absolute value of the difference between the current measured value and the mean value is greater than a certain threshold, the current information of the channel is considered to be unreliable, the signal is rejected, and each statistical characteristic of the channel adopts the previous observed value.
Similarly, the statistical characteristics of the data of each channel are also referred in the wild value elimination process, so that the wild value elimination is more accurate.
Referring to fig. 2, in order to further optimize the above technical solution, the specific steps of the fusion calculation include:
calculating the confidence degree distance of each speed channel according to the speed information at different moments in preset time and a threshold value; wherein the threshold is equal to the sum of the velocity mean, the sensor accuracy value, and the velocity variance;
distributing a weight value to the speed channel based on the ship navigation state and the confidence degree distance;
and performing fusion calculation based on the weight value and the current speed information to obtain the navigational speed of the ship.
During weight distribution, the influence of the ship navigation state is fully considered, so that the finally obtained ship navigation speed is more accurate.
The embodiments in the present description are described in a progressive manner, each embodiment focuses on differences from other embodiments, and the same and similar parts among the embodiments are referred to each other. The device disclosed by the embodiment corresponds to the method disclosed by the embodiment, so that the description is simple, and the relevant points can be referred to the method part for description.
The previous description of the disclosed embodiments is provided to enable any person skilled in the art to make or use the present invention. Various modifications to these embodiments will be readily apparent to those skilled in the art, and the generic principles defined herein may be applied to other embodiments without departing from the spirit or scope of the invention. Thus, the present invention is not intended to be limited to the embodiments shown herein but is to be accorded the widest scope consistent with the principles and novel features disclosed herein.
Claims (3)
1. A method for fusing velocity information, comprising:
1) measuring point layout: the method comprises the following steps that a plurality of speed measuring points are arranged on a ship in a triangular mode, and aiming at the problems of cost and calculation real-time performance, three speed measuring points are arranged on the ship in a triangular mode, and each speed measuring point is provided with a sensor and an amplifier;
2) data acquisition: acquiring speed information by using a sensor and an amplifier, and acquiring the rotating speed and the course of a stern shaft by using a navigation system;
3) data fusion: performing fusion calculation on the data acquired in the step 2) based on the ship navigation state, wherein the fusion calculation specifically comprises the following steps: channel estimation, ship navigation state judgment, wild value elimination and multi-channel information fusion to obtain the navigation speed of the ship; the method specifically comprises the following steps:
calculating the confidence degree distance of each speed channel according to the speed information at different moments in preset time and a threshold value; wherein the threshold is equal to the sum of the velocity mean, the sensor accuracy value, and the velocity variance;
distributing a weight value to the speed channel based on the ship navigation state and the confidence degree distance;
performing fusion calculation based on the weight value and the current speed information to obtain the navigational speed of the ship;
the specific method for removing the wild value comprises the following steps:
the method for eliminating the wild value in the uniform speed direct navigation state comprises the following steps:
in a uniform-speed straight-ahead state, when the absolute value of the difference between the current measured value and the mean value of each speed channel is greater than a certain threshold within a certain continuous period of time, judging that the channel information is not credible, eliminating speed channel information signals, and adopting the previous observed value for each statistical characteristic of the channel;
the method for eliminating the wild value in the variable speed direct navigation state comprises the following steps:
in the variable speed navigation state, the course is stable, the absolute value of the difference between the current measured value and the mean value of the course channel in a certain period of time is greater than a certain threshold, the course channel information is judged to be unreliable and is removed, the course information is set as a default value, and the course information is reinitialized after the preset time is delayed;
the rotation speed of the stern shaft changes, the difference between the rotation speed of the stern shaft and the rotation speed change is larger than a certain threshold in a certain period of time, the rotation speed information of the stern shaft is judged to be unreliable and is rejected, the rotation speed of the stern shaft is set as a previous observed value, and the rotation speed information of the stern shaft is reinitialized after the preset time is delayed;
the information of the electromagnetic speed measuring channel changes, and the speed information of each speed measuring channel is judged to be unreliable and rejected continuously for a certain period of time; wherein, amaxThe maximum acceleration of the ship is taken as the sigma, the velocity variance and the velocity mean value are taken as the sigma, and each statistical characteristic of the channel adopts the previous observed value;
the method for rejecting the wild value in the gyratory navigation state is consistent with the method for judging and rejecting the wild value of the rotating speed of the electromagnetic channel and the screw shaft in the constant-speed and variable-speed navigation states; for course change, if the absolute value of the difference between the current measured value and the mean value of the course channel in a certain period of time is greater than a certain threshold, the course channel information is judged to be unreliable and is removed, or the course channel information is set as a default value under the condition that a fault value is unavailable, and the course information is reinitialized after a delay;
the outlier rejection method under the anchoring state is similar to the outlier rejection method of the uniform speed direct navigation, the course and the navigation speed both keep a certain constant, the rotating speed of the screw shaft is zero, the absolute value of the difference between the current measured value and the mean value of each channel in a certain period of time is greater than a certain threshold, the channel information is judged to be not credible, the signal is rejected, and each statistical characteristic of the channel adopts the previous observed value; for three electromagnetic channels, if the absolute value of the difference between the current measurement value and the mean value is greater than a certain threshold, the current information of the channel is considered to be unreliable, the signal is rejected, and each statistical characteristic of the channel adopts the previous observation value;
the ship navigation state is obtained by judging speed information, the rotating speed of a stern shaft and the course, and comprises four states of uniform speed direct navigation, variable speed direct navigation, gyrus and anchoring;
the channel statistic used for speed estimation is used for channel outlier rejection, channel speed estimation and auxiliary judgment of constant speed, variable speed and anchoring navigation state of a ship body, the mean value and variance of certain channel information in a period of time are counted according to a time sequence, mathematical unbiased estimation is adopted, sampling points are n points, and the calculation method is as follows:
n-1, instead of n, is used in the standard deviation estimation, which is mathematically an unbiased estimation,
and the channel statistics of the rotating speed and the course of the stern shaft are used for judging the current navigation state of the ship, the statistical method is consistent with that of the electromagnetic channel, and the sampling point is m points.
2. The method for fusing speed information according to claim 1, wherein the specific steps of channel estimation comprise: and counting the mean value and the variance of each speed information, the rotating speed of the stern shaft and the course information within the preset time according to the time sequence.
3. The method for fusing speed information according to claim 1, wherein the ship navigation state comprises four states of uniform speed direct navigation, variable speed direct navigation, gyre and anchoring;
the method for judging the uniform speed direct navigation specifically comprises the following steps:
s11: the course information is stable, and the difference value between the current course angle and the mean value of the course angle is within an allowable disturbance range;
s12: the rotation speed of the screw shaft is stable, and the difference value between the current rotation speed of the screw shaft and the mean value of the rotation speed of the screw shaft is in an allowable disturbance range;
s13: the absolute value of the difference value between the current measurement value and the speed average value of the three electromagnetic speed measurement points is smaller than a threshold value;
if S11 is true and one of S12 or S13 is true, the vehicle is determined to be in a uniform direct navigation state;
the method for judging the variable speed direct navigation specifically comprises the following steps:
s21: the course information is stable, and the difference value between the current course angle and the mean value of the course angle is within an allowable disturbance range;
s22: the rotating speed of the stern shaft changes, and the difference value between the current rotating speed of the stern shaft and the mean value of the rotating speed of the stern shaft is not in an allowable disturbance range;
s23: the absolute value of the difference value between the current measurement value and the speed average value of the three paths of electromagnetic speed measurement points is larger than a threshold value, and the symbols are the same;
if the three conditions of S21-S23 are met simultaneously, the state is judged to be a speed-changing straight-driving state;
the method for judging the gyratory navigation specifically comprises the following steps:
s31: changing course information, judging that the current course angle and the mean value of the course angle are in a gyrus state if the difference value of the current course angle and the mean value of the course angle is not in an allowed disturbance range for three times continuously and the signs are the same;
if one of S12 or S13 is satisfied, the rotation is determined to be constant speed rotation; if one of S22 or S23 is satisfied, the speed change is judged to be the speed change rotation, and whether the speed is accelerated or decelerated is judged according to the sign;
the method for judging the anchoring navigation state specifically comprises the following steps:
s41: the course information is stable, the difference value between the current course angle and the mean value of the course angle is within the allowable disturbance range for three times continuously, and the signs are the same;
s42: the rotating speed of the screw shaft is 0, the difference value between the current rotating speed of the screw shaft and the mean value of the rotating speed of the screw shaft is within an allowable disturbance range for three consecutive times, and the symbols are the same;
s43: the absolute values of the difference values between the current measurement values and the speed average values of the three electromagnetic speed measurement points are not larger than a threshold value, the signs are the same, and the speed average value of each speed channel is lower than 3 kn;
if the three conditions of S41-S43 are met simultaneously, the state is judged to be the anchoring navigation state;
and the course angle mean value, the stern shaft rotation speed mean value and the speed mean value are obtained through channel estimation.
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201910849531.0A CN110618290B (en) | 2019-09-09 | 2019-09-09 | Speed information fusion method |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201910849531.0A CN110618290B (en) | 2019-09-09 | 2019-09-09 | Speed information fusion method |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN110618290A CN110618290A (en) | 2019-12-27 |
| CN110618290B true CN110618290B (en) | 2021-09-28 |
Family
ID=68922738
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201910849531.0A Active CN110618290B (en) | 2019-09-09 | 2019-09-09 | Speed information fusion method |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN110618290B (en) |
Families Citing this family (3)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN111323081A (en) * | 2020-03-20 | 2020-06-23 | 江南造船(集团)有限责任公司 | Ship test voyage performance index correction method, correction system, storage medium and electronic terminal |
| CN112258689B (en) * | 2020-10-26 | 2022-12-13 | 上海船舶研究设计院（中国船舶工业集团公司第六0四研究院） | Ship data processing method and device and ship data quality management platform |
| CN112649619A (en) * | 2020-12-09 | 2021-04-13 | 中船航海科技有限责任公司 | Speed error suppression method and suppression system of multi-channel electromagnetic log |
Citations (20)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN101520467A (en) * | 2009-03-24 | 2009-09-02 | 南京长江油运公司 | Vessel main engine energy-saving rotation speed measuring and selecting method and system for realizing same |
| CN101957384A (en) * | 2010-05-17 | 2011-01-26 | 南通中远川崎船舶工程有限公司 | Ship speed reciprocating measurement method |
| RU2444043C1 (en) * | 2010-10-11 | 2012-02-27 | Федеральное государственное образовательное учреждение высшего профессионального образования "Мурманский государственный технический университет" (ФГОУВПО "МГТУ") | Method for parametric identification of ship mathematical model |
| CN103323023A (en) * | 2013-04-26 | 2013-09-25 | 哈尔滨工程大学 | Real time correction method for ship electromagnetic log scale factor |
| CN103466041A (en) * | 2013-09-26 | 2013-12-25 | 长江航运科学研究所 | Real-time optimizing energy-saving ship speed intelligent-analysis system |
| CN105180944A (en) * | 2015-09-17 | 2015-12-23 | 哈尔滨工程大学 | Judgment and compensation method for hull sideslipping speed error |
| CN205210107U (en) * | 2015-11-06 | 2016-05-04 | 中船航海科技有限责任公司 | Biax electromagnetic sensor for electromagnetic log |
| CN105783909A (en) * | 2014-12-26 | 2016-07-20 | 中国科学院沈阳自动化研究所 | HOV mixed underwater navigation locating method based on UKF and PSO-SVM |
| CN106950394A (en) * | 2017-03-01 | 2017-07-14 | 中国船舶重工集团公司第七0七研究所九江分部 | It is a kind of the bidimensional that water tests the speed to be tested the speed electromagnetic sensor for naval vessel |
| EP2981967B1 (en) * | 2013-04-03 | 2017-08-02 | Lockheed Martin Corporation | Magnetic field plasma confinement for compact fusion power reactor |
| CN108333605A (en) * | 2017-12-29 | 2018-07-27 | 武汉理工大学 | A kind of ship navigation shunting judgment method and system based on Differential positioning |
| US10099750B1 (en) * | 2012-01-12 | 2018-10-16 | Paul D. Kennamer, Sr. | High speed ship |
| CN108828550A (en) * | 2018-08-03 | 2018-11-16 | 国网福建省电力有限公司 | A kind of sea cable regional boundary ship target method for detecting position |
| CN109000682A (en) * | 2018-07-27 | 2018-12-14 | 中科宇达（北京）科技有限公司 | The method of aerial coarse alignment based on rectilinear path |
| JP6462490B2 (en) * | 2015-05-29 | 2019-01-30 | 学校法人加計学園 | Superconducting motor and superconducting generator |
| CN109507707A (en) * | 2018-11-12 | 2019-03-22 | 燕山大学 | A kind of integrated navigation control method waterborne and its control system |
| CN109541253A (en) * | 2018-11-29 | 2019-03-29 | 中国船舶重工集团公司第七0七研究所九江分部 | A kind of 2-D electromagnetic to test the speed for naval vessel and the integrated velocity sensor of acoustics |
| CN109840358A (en) * | 2019-01-09 | 2019-06-04 | 上海海洋大学 | A kind of track segmentation method based on track time-domain difference |
| CN109976290A (en) * | 2019-04-26 | 2019-07-05 | 大连海事大学 | A kind of monitoring of unmanned boat operational configuration and security evaluation control system |
| CN110126974A (en) * | 2019-04-23 | 2019-08-16 | 上海艺南科技有限公司 | A kind of ship bubble drag-reduction structure |
-
2019
- 2019-09-09 CN CN201910849531.0A patent/CN110618290B/en active Active
Patent Citations (20)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN101520467A (en) * | 2009-03-24 | 2009-09-02 | 南京长江油运公司 | Vessel main engine energy-saving rotation speed measuring and selecting method and system for realizing same |
| CN101957384A (en) * | 2010-05-17 | 2011-01-26 | 南通中远川崎船舶工程有限公司 | Ship speed reciprocating measurement method |
| RU2444043C1 (en) * | 2010-10-11 | 2012-02-27 | Федеральное государственное образовательное учреждение высшего профессионального образования "Мурманский государственный технический университет" (ФГОУВПО "МГТУ") | Method for parametric identification of ship mathematical model |
| US10099750B1 (en) * | 2012-01-12 | 2018-10-16 | Paul D. Kennamer, Sr. | High speed ship |
| EP2981967B1 (en) * | 2013-04-03 | 2017-08-02 | Lockheed Martin Corporation | Magnetic field plasma confinement for compact fusion power reactor |
| CN103323023A (en) * | 2013-04-26 | 2013-09-25 | 哈尔滨工程大学 | Real time correction method for ship electromagnetic log scale factor |
| CN103466041A (en) * | 2013-09-26 | 2013-12-25 | 长江航运科学研究所 | Real-time optimizing energy-saving ship speed intelligent-analysis system |
| CN105783909A (en) * | 2014-12-26 | 2016-07-20 | 中国科学院沈阳自动化研究所 | HOV mixed underwater navigation locating method based on UKF and PSO-SVM |
| JP6462490B2 (en) * | 2015-05-29 | 2019-01-30 | 学校法人加計学園 | Superconducting motor and superconducting generator |
| CN105180944A (en) * | 2015-09-17 | 2015-12-23 | 哈尔滨工程大学 | Judgment and compensation method for hull sideslipping speed error |
| CN205210107U (en) * | 2015-11-06 | 2016-05-04 | 中船航海科技有限责任公司 | Biax electromagnetic sensor for electromagnetic log |
| CN106950394A (en) * | 2017-03-01 | 2017-07-14 | 中国船舶重工集团公司第七0七研究所九江分部 | It is a kind of the bidimensional that water tests the speed to be tested the speed electromagnetic sensor for naval vessel |
| CN108333605A (en) * | 2017-12-29 | 2018-07-27 | 武汉理工大学 | A kind of ship navigation shunting judgment method and system based on Differential positioning |
| CN109000682A (en) * | 2018-07-27 | 2018-12-14 | 中科宇达（北京）科技有限公司 | The method of aerial coarse alignment based on rectilinear path |
| CN108828550A (en) * | 2018-08-03 | 2018-11-16 | 国网福建省电力有限公司 | A kind of sea cable regional boundary ship target method for detecting position |
| CN109507707A (en) * | 2018-11-12 | 2019-03-22 | 燕山大学 | A kind of integrated navigation control method waterborne and its control system |
| CN109541253A (en) * | 2018-11-29 | 2019-03-29 | 中国船舶重工集团公司第七0七研究所九江分部 | A kind of 2-D electromagnetic to test the speed for naval vessel and the integrated velocity sensor of acoustics |
| CN109840358A (en) * | 2019-01-09 | 2019-06-04 | 上海海洋大学 | A kind of track segmentation method based on track time-domain difference |
| CN110126974A (en) * | 2019-04-23 | 2019-08-16 | 上海艺南科技有限公司 | A kind of ship bubble drag-reduction structure |
| CN109976290A (en) * | 2019-04-26 | 2019-07-05 | 大连海事大学 | A kind of monitoring of unmanned boat operational configuration and security evaluation control system |
Non-Patent Citations (6)
| Title |
|---|
| 《BSRA修正法在测速中的应用探讨》;于刚;《船舶设计通讯》;20090615;全文 * |
| 《Estimation of added resistance and ship speed loss in a seaway》;Mingyu Kim;《Ocean Engineering》;20170627;全文 * |
| 《GPS 在船舶航速和计程仪改正率测定中的应用》;韩波;《航海技术》;20110925;全文 * |
| 《Parametric design and optimisation of high-speed Ro-Ro Passenger ships》;Sotiris Skoupas;《Ocean Engineering》;20190905;全文 * |
| 《利用DGPS 测定船速和计程仪改正率》;杨金龙;《浙江交通职业技术学院学报》;20020925;全文 * |
| 《船舶航速测试技术及方法研究》;韩开封;《中国水运》;20130601;全文 * |
Also Published As
| Publication number | Publication date |
|---|---|
| CN110618290A (en) | 2019-12-27 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN110618290B (en) | Speed information fusion method | |
| CN106324626B (en) | A kind of method and apparatus for filtering GPS location shift point | |
| US20080177427A1 (en) | Device and method for measuring dynamic parameters of an aircraft progressing over an airport zone | |
| CN107458466A (en) | Method and apparatus for determining driver's hand-power square at the steering wheel of vehicle | |
| US20070085706A1 (en) | Intuitive wind velocity and direction presentation | |
| CN107525674A (en) | Frequency method of estimation and detection means are turned based on crestal line probability distribution and localised waving | |
| US8898013B2 (en) | Navigation device and process integrating several hybrid inertial navigation systems | |
| WO2016037035A1 (en) | Airspeed estimation system | |
| EP2360463A1 (en) | Method and system for characterizing wear damage on a rolling-element bearing | |
| CN104006822B (en) | VMT Vehicle-Miles of Travel statistical method | |
| CN107765240A (en) | A kind of determination methods of motion state, device and electronic equipment | |
| US9261883B2 (en) | Systems and methods for performing excessive negative pitch alert and for biasing a sink rate alert | |
| FR2911988A1 (en) | Maximum stabilization height determining method for aircraft, involves determining maximum nominal total height, and determining nominal height matched to maximum nominal total height that aircraft is able to reach | |
| US9483885B2 (en) | Method for detecting a failure of at least one sensor onboard an aircraft implementing wind detection, and associated system | |
| RU2016121554A (en) | Correction method for strapdown inertial navigation system | |
| EP3623818A1 (en) | Pitot-static system blockage detector | |
| CN113032994B (en) | Section multipoint power flow harmonic constant extraction and calculation method and device and electronic equipment | |
| CN105180944A (en) | Judgment and compensation method for hull sideslipping speed error | |
| RU2754396C1 (en) | Adaptive method for correcting orientation angles of strapdown ins | |
| JP2000121658A (en) | Train position detecting device and method | |
| CN110648557B (en) | Relative field acquisition method based on ship cluster situation for limited water area | |
| CN113895587A (en) | Full-rotation rudder paddle state monitoring method and system based on artificial intelligence | |
| CN206920132U (en) | The instantaneous detection means for turning frequency method of estimation based on crestal line probability distribution and local fluctuation characteristic | |
| US7424349B2 (en) | Speed display device for a vehicle | |
| WO2001013138A1 (en) | Method and device at flying vehicle for detecting a collision risk |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| PB01 | Publication | ||
| PB01 | Publication | ||
| SE01 | Entry into force of request for substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant |