CN111427007B - Mine personnel safety state estimation method based on centralized personnel filtering under incomplete measurement - Google Patents
Mine personnel safety state estimation method based on centralized personnel filtering under incomplete measurement Download PDFInfo
- Publication number
- CN111427007B CN111427007B CN202010330263.4A CN202010330263A CN111427007B CN 111427007 B CN111427007 B CN 111427007B CN 202010330263 A CN202010330263 A CN 202010330263A CN 111427007 B CN111427007 B CN 111427007B
- Authority
- CN
- China
- Prior art keywords
- mine
- measurement
- ellipsoid
- matrix
- filter
- 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
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S5/00—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations
- G01S5/02—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves
- G01S5/12—Position-fixing by co-ordinating two or more direction or position line determinations; Position-fixing by co-ordinating two or more distance determinations using radio waves by co-ordinating position lines of different shape, e.g. hyperbolic, circular, elliptical or radial
Landscapes
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
The invention discloses a mine personnel safety state estimation method based on collective filtering under incomplete measurement, which fully considers the incomplete measurement of a wireless sensor and unknown but bounded noise in a mine environment and constructs a collective filter based on the incomplete measurement. In order to effectively process the nonlinear error in the positioning system of the mine workers, the system measurement equation is subjected to linearization processing, a scaling matrix and an unknown matrix are adopted to represent the linearization error, and the scaling matrix is processed by utilizing a particle swarm algorithm, so that the problem of linearization of the system is effectively solved, and the accurate positioning of the mine workers is realized. In addition, the invention determines various filtering parameters through semi-positive planning, and provides a recursive filtering algorithm to calculate the minimum state estimation ellipsoid containing the real state of the mine operator, thereby improving the reliability of the positioning system of the mine operator.
Description
Technical Field
The invention relates to a mine personnel safety state estimation method based on centralized personnel filtering under incomplete measurement.
Background
In the technical field of mine industrial safety, a wireless positioning system has important application and has important practical significance for guaranteeing the safety of mine operators. The wireless positioning system generally adopts advanced wireless transmission network information facilities, and the wireless intelligent node senses data locally and cooperates with other sensors to exchange relevant information of a monitored object.
In actual engineering, a wireless positioning system is used for tracking and positioning personnel on an industrial site, so that the sensing capability of the industrial monitoring system on safety information is improved. However, the energy supply of wireless sensors is rather limited. If the wireless sensor periodically transmits the measured signal according to the traditional time-based communication scheme, a large amount of unnecessary transmission on a wireless network can be caused, so that the energy consumption of the wireless sensor is overlarge, and the service life of the wireless sensor is greatly shortened.
In addition, the wireless communication environment of the mine site is relatively complex, and various measurement noises and interferences exist. And the distance between the wireless sensor and the target is usually modeled by a certain nonlinear function. Therefore, various non-linear filters (e.g., extended kalman filter, unscented kalman filter) have emerged to address the estimation problem in wireless positioning systems. However, these filters need to assume that the noise sources are random white noise and gaussian noise. However, in the practical application of the wireless positioning system, the probability assumption of the system noise sometimes does not meet the real situation, and the more reasonable assumption is that the system noise is unknown but bounded.
In summary, it is more practical to consider the incomplete measurement of the wireless sensor and the unknown but bounded noise in the mine environment.
Disclosure of Invention
The invention aims to provide a mine personnel safety state estimation method based on centralized personnel filtering under incomplete measurement, so that the position positioning of mine operation personnel can be accurately realized under the condition of incomplete measurement.
In order to achieve the purpose, the invention adopts the following technical scheme:
the mine personnel safety state estimation method based on centralized personnel filtering under incomplete measurement comprises the following steps:
I. arranging a plurality of wireless sensors above a mine working area, and collecting position and speed information of mine operators;
II, establishing a mine worker positioning system model;
the system model establishment process is as follows:
the state quantity x of the mine worker moving in the mine working areakIncluding position and velocity, expressed as the following vector:
xk=[x1,k v1,k x2,k v2,k]T (1)
wherein x iskThe vector is a 4-dimensional vector and represents the state of the mine worker; (x)1,k,x2,k) Indicating mine operator at time tkPosition coordinates of time; (v)1,k,v2,k) Indicating mine operator at time tkA velocity coordinate of time;
giving out a dynamic state equation x of mine operatorsk+1The following were used:
xk+1=Akxk+Bkuk+ωk (2)
wherein, Δ tk=tk+1-tkThe time interval between two continuous sampling moments in the mine worker positioning system consisting of the plurality of wireless sensors is shown; vector ukRepresenting the variation trend of the state track; omegakIs process noise;
defining the number of the wireless sensors as m, wherein m is a natural number greater than 0; wherein the ith wireless sensor is at time tkIs measured as yi,kI is more than 0 and less than or equal to m; the expression of the measurement equation is:
wherein the content of the first and second substances,for measuring noise vkA component of (a); gi(xk) As a function of distance, gi(xk) The expression of (a) is:
wherein the content of the first and second substances,representing the position coordinates of the ith wireless sensor; to simplify the expression, let:
the measurement results were then rewritten as:
yk=g(xk)+vk (6)
Wherein the process noise omegak∈RnFor n-dimensional vectors, n is taken to be 4, and the noise v is measuredk∈RmIs an m-dimensional vector;
process noise omegak∈RnAnd the measurement noise vk∈RmBelong to the following ellipsoid sets W and V, respectively:
wherein Q iskAnd RkIs a known positive definite symmetric matrix describing the size and shape of an ellipsoid;
constructing a centralized filter based on incomplete measurement according to the mine operator positioning system model;
III.1, constructing a transmission mechanism under incomplete measurement;
the wireless sensors are mutually independent and respectively adopt a transmission mechanism under incomplete measurement to transmit information; the transmission time sequence of the information defining the ith wireless sensor under incomplete measurement is expressed as:
wherein the content of the first and second substances,the information is transmitted for the t +1 th time at the k moment by the wireless sensor i; t is 0,1,2 …;
the following formula is defined:
wherein σi,kQuantity measurement representing previous transmission of ith wireless sensorMeasure y from the current quantityi,kA difference of (d);
thus, the information transfer function fi(-) is defined as follows:
wherein, deltaiDetermining a parameter for transmission of a wireless sensor i; according to the transmission scheme under incomplete measurement, the wireless sensor i sends the measurement to the ensemble filter only when equation (10) holds:
fi(σi,k,δi)>0 (10)
therefore, the transmission timing under incomplete measurement is shown in equation (11):
wherein the content of the first and second substances,the information is transmitted for the t +2 th time at the k moment by the wireless sensor i; inf { } represents the minimum value satisfying the constraint in brackets, and N represents a natural number; in addition, the signal received by the collector filter from the wireless sensor iInformation representationComprises the following steps:
thus, σi,kThe values are shown in formula (13):
III.2, constructing a centralized member filter based on incomplete measurement;
according to the transmission mechanism under incomplete measurement constructed in step iii.1, in combination with the formula (2) -formula (6) mentioned in step II, the structure of the membership filter based on incomplete measurement is proposed as follows:
wherein, among others,representing the center of the estimated ellipsoid at time k +1,representing the center of an estimated ellipsoid at the moment k;representing a predicted quantity measurement;Kka filter gain matrix required to be solved for the collector filter;
Pk+1estimating a shape matrix of the ellipsoid for the state;
IV, carrying out linear processing on a measurement equation of the mine operator positioning system;
the estimated error e is obtained from the equations (2) and (15)k+1Expressed as:
wherein the content of the first and second substances,according to equation (8), the amount of measurements received by the ensemble filter from the wireless sensor is expressed as:
and, using Taylor's expansion, the non-linear measurement equation g (x)k) The linear representation is:
wherein the content of the first and second substances,Lαis a scaling matrix, ΔαIs an unknown matrix, and|Δα||≤1;
then, the formula (18) is substituted into the formula (6) to obtain:
in conjunction with equations (16) and (17), the estimation error is expressed as:
scaling matrix LαThe method is obtained by a particle swarm optimization method, and comprises the following specific steps:
obtaining a scaling matrix by analyzing a linearization errorWherein E iskFrom PkIs decomposed to obtainPkEstimate the shape matrix of the ellipsoid, | | E for the statekI is EkEuclidean norm of;
Wherein the content of the first and second substances,is composed ofEuclidean norm of gi(xk) Is g (x)k) The ith component of (a);
if presentAnd the parameter z is present to ensure that the < I < Z > is less than or equal to 1, and the < I < Z > is zA Euclidean norm;
then equation (21) holds:
obviously, NiIs influenced by z; thus, scaling the matrix LαTranslates into the following optimization problem:
in order to obtain the optimal solution of the formula (22) when the condition of < I < Z > is less than or equal to 1, solving by adopting a particle swarm algorithm;
in the particle swarm algorithm, the particles move according to a position and speed formula to obtain an optimal solution, wherein the position and speed formula is as follows:
wherein x isl(s)=[xl1(s),...,xld(s)]Is the location of the ith particle in the s iteration;
vl(s)=[vl1(s),...,vld(s)]the velocity of the l-th particle in the s-th iteration; w is the inertial weight;
two acceleration coefficients c1And c2Referred to as cognitive parameters and social parameters, respectively;
r1and r2Are respectively uniformly distributed in [0,1 ]]A random number in between;
pl(s) and pg(s) local optimal position and global optimal position of the population in the s-th iteration, respectively;
the particles move according to the position and speed formula shown in the formula (23), and the obtained global optimal position p is subjected to b times of iterative movementg(b) Substituting in formula (22) to obtain NiTo obtain a scaling matrix L at time kα;
WhileRepresents g (x)k) The high-order item in the Taylor expansion process completes the linearization of the measurement equation of the positioning system of the mine operating personnel; wherein a and b are both constants;
v, determining various filtering parameters of the collector filter;
v.1, determining constraint conditions met by various filtering parameters of the collector filter;
for the mine worker positioning system, the initial state of the system is set to be x0The estimated value thereofSatisfies the following conditions:
wherein, P0Is a given positive definite symmetric matrix;
Then, if there is a filter parameter Pk+1>0,Kk,λ1>0,λ2>0,λ3>0,λ4> 0 and lambda5If > 0, the linear matrix inequality shown in the formula (25) is satisfied; then:
Wherein the content of the first and second substances,i denotes an identity matrix, Πk=[0 (Ak-KkGk)Ek 1 -KkLα -Kk -Kk];
Each filtering parameter satisfies the constraint shown in formula (25); in addition, the center of the state estimation ellipsoid is determined by equation (15);
v.2, determining each filtering parameter of the collector filter according to a semi-positive planning method;
determining an optimum state ellipsoid by applying a semi-positive definite programming method, and determining each filtering parameter by solving the following optimization problems:
wherein trace (P)k+1) Representing the shape matrix Pk+1Each filter parameter of the trace (1) meets the constraint shown in the formula (25); obtaining the P through a semi-positive definite programming methodk+1The value of each filtering parameter when the trace of (A) is minimum;
substituting each filtering parameter into the step III to obtain a centralized filter based on incomplete measurement;
VI, positioning the mine operating personnel by using a centralized filter;
recursion of the collector filter is used for obtaining the positioning ellipsoid center at the k +1 momentAnd positioning the ellipsoid-shaped matrix Pk+1The state quantity x of the mine workerk+1In thatIn the represented ellipsoid, a person position fix is achieved.
The invention has the following advantages:
as described above, the present invention provides a mine personnel safety state estimation method based on incomplete measurement centralized filtering, which fully considers the incomplete measurement of a wireless sensor and unknown but bounded noise in a mine environment, and constructs a centralized filter based on incomplete measurement according to a mine operator positioning system model. In order to effectively process nonlinear errors in the mine operator positioning system, the measurement equation of the mine operator positioning system is subjected to linearization processing, a scaling matrix and an unknown matrix are adopted to express the linearization errors in the linearization processing, and the scaling matrix is processed by using a particle swarm algorithm, so that the linearization problem of the system is effectively solved, and the accurate positioning of the position of the mine operator is realized; in addition, the method determines various filtering parameters through semi-positive definite planning, and provides a recursive filtering algorithm to calculate a minimum state estimation ellipsoid containing the real state of the mine operator, so that the reliability of the positioning system of the mine operator is improved.
Drawings
Fig. 1 is a flowchart of a mine personnel safety state estimation method based on incomplete measurement centralized filtering in the invention.
Fig. 2 is a schematic layout diagram of wireless sensors according to an embodiment of the present invention.
Fig. 3 is a schematic diagram of transmission timings of the sensors when the transmission determination parameter is 0.6 according to the embodiment of the present invention.
FIG. 4 is a schematic diagram showing a comparison between a real trajectory and an estimated trajectory of a mine operator in an embodiment of the invention.
FIG. 5 is a schematic diagram illustrating a comparison between the real state coordinate value and the estimated state coordinate value of the mine operator according to an embodiment of the present invention.
FIG. 6 is a diagram illustrating a comparison of the actual status and estimated boundaries of mine workers in an embodiment of the present invention.
Detailed Description
The invention is described in further detail below with reference to the following figures and detailed description:
as shown in fig. 1, the mine personnel safety state estimation method based on collective filtering under incomplete measurement includes the following steps:
I. a plurality of wireless sensors are arranged above a mine working area, and position and speed information of mine operators is collected.
As shown in fig. 2, in order to improve the safety monitoring capability of the mine workers, for example, 6 wireless sensors may be deployed above the mine working area, so as to perform safety monitoring on the workers in the area.
The wireless sensors are respectively used for collecting information such as the position and the speed of mine workers. And this information will be transmitted to the filter for personnel (security status or) location estimation, in selected parts, by means of a transmission mechanism under incomplete measurement.
Of course, the number of wireless sensors in the present embodiment is not limited to the above 6, and is only exemplified here.
And II, after receiving the position and speed information of the mine operating personnel, establishing a mine operating personnel positioning system model.
The system model establishment process is as follows:
setting the state quantity x of the mine operator when the mine operator moves in the mine working areakIncluding position and velocity, expressed as the following vector:
xk=[x1,k v1,k x2,k v2,k]T (1)
wherein x iskThe vector is a 4-dimensional vector and represents the state of the mine worker; (x)1,k,x2,k) Indicating mine operator at time tkOf the hourA position coordinate; (v)1,k,v2,k) Indicating mine operator at time tkThe velocity coordinate of time.
Giving out a dynamic state equation x of mine operatorsk+1The following were used:
xk+1=Akxk+Bkuk+ωk (2)
wherein, Δ tk=tk+1-tkThe time interval between two continuous sampling moments in the mine worker positioning system consisting of the plurality of wireless sensors is shown; vector ukRepresenting the variation trend of the state track; omegakIs process noise.
The number of the wireless sensors is defined as m, and m is a natural number greater than 0. Wherein the ith wireless sensor is at time tkIs measured as yi,kI is more than 0 and less than or equal to m; the expression of the measurement equation is:
wherein the content of the first and second substances,for measuring noise vkA component of (a); gi(xk) As a function of distance, gi(xk) The expression of (a) is:
wherein the content of the first and second substances,indicating the location coordinates of the ith wireless sensor. To simplify the expression, let:
the measurement results were then rewritten as:
yk=g(xk)+vk (6)
Wherein the process noise omegak∈RnFor n-dimensional vectors, n is taken to be 4, and the noise v is measuredk∈RmIs an m-dimensional vector; process noise omegak∈RnAnd the measurement noise vk∈RmBelong to the following ellipsoid sets W and V, respectively:
wherein Q iskAnd RkIs a known positive definite symmetric matrix describing the size and shape of the ellipsoid.
And III, constructing a centralized filter based on incomplete measurement according to the mine operator positioning system model.
The construction process of the membership filter based on incomplete measurement proposed in the embodiment can be divided into the following two steps:
and III.1, constructing a transmission mechanism under incomplete measurement.
After the wireless sensor collects the position and speed equivalent measurement information of the mine operation personnel, the measurement information needs to be transmitted to the filter for personnel positioning processing. In order to achieve the purpose of energy saving, the measured signals on the wireless sensors cannot be transmitted completely. In the case of such incomplete measurement, a special information transmission mechanism is proposed.
And each wireless sensor judges whether the current measurement is sent to the filter or not according to the difference value between the previous transmitted measurement and the current measurement. In this way, the wireless sensor can adjust its own transmission rate according to the dynamic change of the sensing signal, thereby reducing the data amount transmitted to the filter. In addition, in order to improve the energy efficiency of the sensors and ensure the estimation performance of the positioning system, each wireless sensor can independently execute the transmission strategy without considering the consistency with other sensors in the cluster.
The transmission mechanism under the incomplete measurement can effectively reduce energy consumption and obviously prolong the service life of the wireless sensor.
The transmission time sequence of the information defining the ith wireless sensor under incomplete measurement is expressed as:
wherein the content of the first and second substances,the information is transmitted for the t +1 th time at the k moment by the wireless sensor i; t is 0,1,2 ….
The following formula is defined:
wherein σi,kQuantity measurement representing previous transmission of ith wireless sensorMeasure y from the current quantityi,kThe difference of (a).
Thus, the information transfer function fi(-) is defined as follows:
wherein, deltaiThe parameters are judged for the transmission of the wireless sensor i. Based on the transmission mechanism under incomplete measurement, the wireless sensor i is only in the formula (1)0) The measurements are sent to the collector filter when it is established:
fi(σi,k,δi)>0 (10)
therefore, the transmission timing under incomplete measurement is shown in equation (11):
wherein the content of the first and second substances,the wireless sensor i transmits information for the t +2 th time at the k moment, inf { } represents the minimum value meeting the constraint in brackets, and N represents a natural number. In addition, the information received by the collective filter from the wireless sensor i representsComprises the following steps:
thus, σi,kThe values are shown in formula (13):
the transmission mechanism in this embodiment can adjust the transmission frequency of the information according to the variation characteristic of the measurement, thereby ensuring the transmission performance. Compared with the traditional time-based transmission scheme, the transmission mechanism in the embodiment improves the resource utilization efficiency by reasonably reducing redundant transmission, and simultaneously ensures the required filtering performance.
And III.2, constructing a membership filter based on incomplete measurement.
The collective filtering is to describe the true state of the system by a collection of outer bounding ellipsoids that contain the model structure, measurement data, and noise boundaries of the system, resulting in a set of feasible states for the state information.
The set of feasible states consists of the state and measurement equations of the system, noise boundaries, measurement outputs and initial state values.
Compared with methods such as Kalman filtering and the like which need to know the statistical characteristics of the noise, the method adopts the centralized filtering which only needs to know the boundary of the noise, so that the method is more suitable for processing unknown bounded noise in the mine environment.
According to the transmission mechanism under incomplete measurement constructed in step iii.1, in combination with the formula (2) -formula (6) mentioned in step II, the structure of the membership filter based on incomplete measurement is proposed as follows:
wherein the content of the first and second substances,representing the center of the estimated ellipsoid at time k +1,representing the center of an estimated ellipsoid at the moment k;representing a predicted quantity measurement;Kkthe filter gain matrix that needs to be solved for the ensemble filter.
And IV, carrying out linearization processing on the measurement equation of the mine operator positioning system.
In the embodiment, the measurement equation of the system mine operator positioning system is a nonlinear function, and if the nonlinear terms involved are processed according to the traditional extended kalman filter algorithm, the high-order terms generated by the taylor expansion are simply ignored, and the conservatism is inevitably caused in some cases, so that the precision is reduced.
When the measurement equation of the positioning system of the mine workers is subjected to linearization processing, the embodiment adopts the scaling matrix and the unknown matrix to express the linearization error, and utilizes the particle swarm algorithm to process the scaling matrix, so that the linearization problem of the positioning system of the mine workers is effectively solved, and the positioning accuracy of the mine workers is improved.
The estimated error e is obtained from the equations (2) and (15)k+1Expressed as:
wherein the content of the first and second substances,according to equation (8), the amount of measurements received by the ensemble filter from the wireless sensor is expressed as:
and, using Taylor's expansion, the non-linear measurement equation g (x)k) The linear representation is:
wherein the content of the first and second substances,Lαis an indeterminate scaling matrix, ΔαIs an unknown matrix, and | | | Δα||≤1。
Then, the formula (18) is substituted into the formula (6) to obtain:
in conjunction with equations (16) and (17), the estimation error is expressed as:
scaling matrix LαThe method is obtained by a particle swarm optimization method, and comprises the following specific steps:
obtaining a scaling matrix by analyzing a linearization errorWherein E iskFrom PkIs decomposed to obtainPkEstimate the shape matrix of the ellipsoid, | | E for the statekI is EkEuclidean norm of.
Wherein the content of the first and second substances,is composed ofEuclidean norm of gi(xk) Is g (x)k) The ith component of (a).
If presentAnd the parameter z is present to ensure that the | z | is less than or equal to 1, and the | z | is the Euclidean norm of z.
Then equation (21) holds:
obviously, NiIs influenced by z. Thus, scaling the matrix LαTranslates into the following optimization problem:
In order to obtain the optimal solution of the formula (22) when the condition of < i > z < i > is less than or equal to 1, a particle swarm algorithm is adopted for solving.
In the particle swarm algorithm, the particles move according to a position and speed formula to obtain an optimal solution, wherein the position and speed formula is as follows:
wherein x isl(s)=[xl1(s),...,xld(s)]Is the location of the ith particle in the s iteration;
vl(s)=[vl1(s),...,vld(s)]the velocity of the l-th particle in the s-th iteration; w is the inertial weight;
two acceleration coefficients c1And c2Referred to as cognitive parameters and social parameters, respectively;
r1and r2Are respectively uniformly dividedIs distributed on [0,1 ]]A random number in between;
pl(s) and pg(s) are the local optimal location and global optimal location of the population in the s-th iteration, respectively.
the particles move according to the position and speed formula shown in (23), and after b times of iterative movement, the obtained global optimal position pg(b) Into formula (22) to obtain NiThe value is obtained.
Wherein a and b are constants, and the values of a and b are determined according to time and precision requirements and actual conditions.
By means of particle swarm algorithm, obtaining accurate NiA value; further, a scaling matrix L at the time k is obtainedαTo do soRepresents g (x)k) And (4) completing linearization of a measurement equation of the positioning system of the mine workers by using a high-order term in the Taylor expansion process.
In the embodiment, the measurement equation of the positioning system of the mine workers is subjected to linear processing, which is determined by the accurate positioning requirement of the mine environment on the mine workers, so that the safety of the mine workers is ensured.
Conventionally, the higher order terms of the Taylor expansion are ignored, which inevitably reduces the accuracy of the state estimation, and the embodiment of the present invention takes this point into account, and uses the higher order termsAnd (4) showing.
The embodiment makes full use of the boundedness of the high-order item, can more accurately obtain the filtering parameters of the collector filter, further improves the filtering performance of the filter, and finally is beneficial to improving the positioning accuracy of mine workers.
V. determining the filter parameters of the ensemble filter. The determination of the filter parameters can be divided into the following two steps:
and V.1, determining the constraint conditions met by each filtering parameter of the member filter.
For the mine worker positioning system, the initial state of the system is set to be x0The estimated value thereofSatisfies the following conditions:
wherein, P0Is a given positive definite symmetric matrix.
Then, if there is a filter parameter Pk+1>0,Kk,λ1>0,λ2>0,λ3>0,λ4> 0 and lambda5If > 0, the linear matrix inequality shown in the formula (25) is satisfied; then:
Wherein the content of the first and second substances,i denotes an identity matrix, Πk=[0 (Ak-KkGk)Ek 1 -KkLα -Kk -Kk]。
Each filtering parameter satisfies the constraint shown in formula (25); in addition, the center of the state estimation ellipsoid is determined by equation (15).
V.2, determining each filtering parameter of the collector filter according to a semi-positive planning method;
determining an optimal state estimation ellipsoid by applying a semi-positive definite programming method, and determining each filtering parameter by solving the following optimization problems:
wherein trace (P)k+1) Representing the shape matrix Pk+1Each filter parameter of the trace (1) meets the constraint shown in the formula (25); obtaining the P through a semi-positive definite programming methodk+1The value of each filtering parameter when the trace of (A) is minimum;
and substituting each filtering parameter into the step III to obtain the centralized filter based on incomplete measurement.
VI, positioning mine operating personnel according to the filter algorithm;
recursion of the collector filter is used for obtaining the positioning ellipsoid center at the k +1 momentAnd positioning the ellipsoid-shaped matrix Pk+1The state quantity x of the mine workerk+1In thatIn the represented ellipsoid, a person position fix is achieved.
Compared with the traditional Kalman filtering method and the like which need to know the statistical characteristics of the noise, the centralized filtering adopted by the embodiment of the invention only needs to know the boundary of the noise, so that the method and the device are more suitable for processing the unknown bounded noise in the mine environment.
In addition, considering that the energy supply of the wireless sensor is quite limited, the information obtained by the wireless sensor is not sent to the filter completely, but is transmitted through a transmission mechanism under incomplete measurement, so that the limited energy of the wireless sensor is saved, the service life of the sensor is longer, the filter obtains useful information as much as possible, and the estimation precision is ensured.
In addition, in consideration of the nonlinearity of the system measurement equation, the embodiment of the invention adopts the scaling matrix and the unknown matrix to express the high-order item in the linearization process of the measurement equation instead of simply neglecting the high-order item, thereby reducing the linearization error, improving the estimation precision of the collective filter, further being beneficial to improving the positioning precision of the mine operators and ensuring the safety of the mine operators.
Fig. 3 shows the times when the six wireless sensors S1 to S6 transmit data when the transmission determination parameter is 0.6. As can be seen from fig. 3, the wireless sensor does not transmit all the information to the collector filter, but selectively transmits the information, so that the energy consumption is reduced, and the service life of the wireless sensor is effectively prolonged. The six wireless sensors are mutually independent and adopt a transmission mechanism under incomplete measurement to transmit information, so the information transmission moments of the six wireless sensors are different, the information transmitted to the filter by each wireless sensor can be effectively complemented, and the situation that the 6 wireless sensors cannot transmit the information to the filter at a certain moment is avoided as much as possible.
Fig. 4 is a schematic diagram comparing the real track and the estimated track of the mine worker. By comparison, the centralized member filter can well estimate the track of the mine worker. FIG. 5 is a schematic diagram showing the comparison between the real state coordinate value and the estimated state coordinate value of the mine operator. Wherein (x1, x2) represents the position coordinates of the mine worker, and the coordinates are compared when the sampling time is from 0 to 200. As can be seen from fig. 5, the state coordinate values estimated by the ensemble filter are very different from the true state coordinate values. Through the comparison, the method disclosed by the invention has a good effect on the estimation of the safety state of the mine personnel. This is because although the information obtained by the membership filter is reduced in the case of incomplete measurement, the wireless sensor selects more effective information for transmission by the transmission mechanism under incomplete measurement proposed by the present invention. Therefore, the invention can reasonably reduce redundant transmission and improve the resource utilization efficiency on the basis of ensuring the required filtering performance.
Fig. 6 is a schematic diagram comparing the actual state and estimated boundaries of the mine operator. Where (x1, x2) represents the position coordinates of the mine worker. As can be seen from fig. 6, when the sampling time is from 0 to 200, the real state of the mine worker is always between the estimated boundaries obtained by the membership filter constructed in the embodiment of the present invention, and it is ensured that the real value is always within the estimated range, thereby facilitating more reasonable and effective safety management for the mine worker.
It should be understood, however, that the description herein of specific embodiments is not intended to limit the invention to the particular forms disclosed, but on the contrary, the intention is to cover all modifications, equivalents, and alternatives falling within the spirit and scope of the invention as defined by the appended claims.
Claims (1)
1. A mine personnel safety state estimation method based on incomplete measurement centralized filtering is characterized in that,
the method comprises the following steps:
I. arranging a plurality of wireless sensors above a mine working area, and collecting position and speed information of mine operators;
II, establishing a mine worker positioning system model;
the system model establishment process is as follows:
the state quantity x of the mine worker moving in the mine working areakIncluding position and velocity, expressed as the following vector:
xk=[x1,k v1,k x2,k v2,k]T (1)
wherein x iskIs a 4-dimensional vector and is a vector,indicating the state of the mine operator; (x)1,k,x2,k) Indicating mine operator at time tkPosition coordinates of time; (v)1,k,v2,k) Indicating mine operator at time tkA velocity coordinate of time;
giving out a dynamic state equation x of mine operatorsk+1The following were used:
xk+1=Akxk+Bkuk+ωk (2)
wherein, Δ tk=tk+1-tkThe time interval between two continuous sampling moments in the mine worker positioning system consisting of the plurality of wireless sensors is shown; vector ukRepresenting the variation trend of the state track; omegakIs process noise;
defining the number of the wireless sensors as m, wherein m is a natural number greater than 0; wherein the ith wireless sensor is at time tkIs measured as yi,kI is more than 0 and less than or equal to m; the expression of the measurement equation is:
wherein the content of the first and second substances,for measuring noise vkA component of (a); gi(xk) As a function of distance, gi(xk) The expression of (a) is:
wherein the content of the first and second substances,representing the position coordinates of the ith wireless sensor; to simplify the expression, let:
the measurement results were then rewritten as:
yk=g(xk)+vk (6)
Wherein the process noise omegak∈RnFor n-dimensional vectors, n is taken to be 4, and the noise v is measuredk∈RmIs an m-dimensional vector;
process noise omegak∈RnAnd the measurement noise vk∈RmBelong to the following ellipsoid sets W and V, respectively:
wherein Q iskAnd RkIs a known positive definite symmetric matrix describing the size and shape of an ellipsoid;
constructing a centralized filter based on incomplete measurement according to the mine operator positioning system model;
III.1, constructing a transmission mechanism under incomplete measurement;
the wireless sensors are mutually independent and respectively adopt a transmission mechanism under incomplete measurement to transmit information; the transmission time sequence of the information defining the ith wireless sensor under incomplete measurement is expressed as:
wherein the content of the first and second substances,the information is transmitted for the t +1 th time at the k moment by the wireless sensor i; t is 0,1,2 …;
the following formula is defined:
wherein σi,kQuantity measurement representing previous transmission of ith wireless sensorMeasure y from the current quantityi,kA difference of (d);
thus, the information transfer function fi(-) is defined as follows:
wherein, deltaiDetermining a parameter for transmission of a wireless sensor i; according to the transmission scheme under incomplete measurement, the wireless sensor i sends the measurement to the ensemble filter only when equation (10) holds:
fi(σi,k,δi)>0 (10)
therefore, the transmission timing under incomplete measurement is shown in equation (11):
wherein the content of the first and second substances,denotes the t + of wireless sensor i at the moment k2 times of information transmission; inf { } represents the minimum value satisfying the constraint in brackets, and N represents a natural number; in addition, the information received by the collective filter from the wireless sensor i representsComprises the following steps:
thus, σi,kThe values are shown in formula (13):
III.2, constructing a centralized member filter based on incomplete measurement;
according to the transmission mechanism under incomplete measurement constructed in step iii.1, in combination with the formula (2) -formula (6) mentioned in step II, the structure of the membership filter based on incomplete measurement is proposed as follows:
wherein, among others,representing the k +1 time estimateThe center of the ellipsoid is the center of the ellipsoid,representing the center of an estimated ellipsoid at the moment k;representing a predicted quantity measurement;Kka filter gain matrix required to be solved for the collector filter;
wherein, Pk+1Estimating a shape matrix of the ellipsoid for the state;
IV, carrying out linear processing on a measurement equation of the mine operator positioning system;
the estimated error e is obtained from the equations (2) and (15)k+1Expressed as:
wherein the content of the first and second substances,according to equation (8), the amount of measurements received by the ensemble filter from the wireless sensor is expressed as:
and, using Taylor's expansion, the non-linear measurement equation g (x)k) The linear representation is:
wherein the content of the first and second substances,Lαis a scaling matrix, ΔαIs an unknown matrix, and | | | Δα||≤1;
Then, the formula (18) is substituted into the formula (6) to obtain:
in conjunction with equations (16) and (17), the estimation error is expressed as:
scaling matrix LαThe method is obtained by a particle swarm optimization method, and comprises the following specific steps:
obtaining a scaling matrix by analyzing a linearization errorWherein E iskFrom PkIs decomposed to obtainPkEstimate the shape matrix of the ellipsoid, | | E for the statekI is EkEuclidean norm of;
Wherein the content of the first and second substances,is composed ofEuclidean norm of gi(xk) Is g (x)k) The ith component of (a);
if presentAnd the existence of the parameter z ensures that the < I < Z > is less than or equal to 1, and the < I > z < I > is the Euclidean norm of z;
then equation (21) holds:
obviously, NiIs influenced by z; thus, scaling the matrix LαTranslates into the following optimization problem:
in order to obtain the optimal solution of the formula (22) when the condition of < I < Z > is less than or equal to 1, solving by adopting a particle swarm algorithm;
in the particle swarm algorithm, the particles move according to a position and speed formula to obtain an optimal solution, wherein the position and speed formula is as follows:
wherein x isl(s)=[xl1(s),...,xld(s)]Is the location of the ith particle in the s iteration;
vl(s)=[vl1(s),...,vld(s)]the velocity of the l-th particle in the s-th iteration; w is the inertial weight;
two acceleration coefficients c1And c2Referred to as cognitive parameters and social parameters, respectively;
r1and r2Are respectively uniformly distributed in [0,1 ]]A random number in between;
pl(s) and pg(s) local optimal position and global optimal position of the population in the s-th iteration, respectively;
the particles move according to the position and speed formula shown in the formula (23), and the obtained global optimal position p is subjected to b times of iterative movementg(b) Substituting in formula (22) to obtain NiTo obtain a scaling matrix L at time kα;
WhileRepresents g (x)k) The high-order item in the Taylor expansion process completes the linearization of the measurement equation of the positioning system of the mine operating personnel; wherein a and b are both constants;
v, determining various filtering parameters of the collector filter;
v.1, determining constraint conditions met by various filtering parameters of the collector filter;
for the mine worker positioning system, the initial state of the system is set to be x0The estimated value thereofSatisfies the following conditions:
wherein, P0Is a given positive definite symmetric matrix;
Then, if there is a filter parameter Pk+1>0,Kk,λ1>0,λ2>0,λ3>0,λ4> 0 and lambda5If > 0, the linear matrix inequality shown in the formula (25) is satisfied; then:
Wherein the content of the first and second substances,i denotes an identity matrix, Πk=[0 (Ak-KkGk)Ek 1 -KkLα -Kk -Kk];
Each filtering parameter satisfies the constraint shown in formula (25); in addition, the center of the state estimation ellipsoid is determined by equation (15);
v.2, determining each filtering parameter of the collector filter according to a semi-positive planning method;
determining an optimum state ellipsoid by applying a semi-positive definite programming method, and determining each filtering parameter by solving the following optimization problems:
wherein trace (P)k+1) Representing the shape matrix Pk+1Each filter parameter of the trace (1) meets the constraint shown in the formula (25); obtaining the P through a semi-positive definite programming methodk+1The value of each filtering parameter when the trace of (A) is minimum;
substituting each filtering parameter into the step III to obtain a centralized filter based on incomplete measurement;
VI, positioning the mine operating personnel by using a centralized filter;
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010330263.4A CN111427007B (en) | 2020-04-24 | 2020-04-24 | Mine personnel safety state estimation method based on centralized personnel filtering under incomplete measurement |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010330263.4A CN111427007B (en) | 2020-04-24 | 2020-04-24 | Mine personnel safety state estimation method based on centralized personnel filtering under incomplete measurement |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111427007A CN111427007A (en) | 2020-07-17 |
CN111427007B true CN111427007B (en) | 2021-03-19 |
Family
ID=71554503
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010330263.4A Active CN111427007B (en) | 2020-04-24 | 2020-04-24 | Mine personnel safety state estimation method based on centralized personnel filtering under incomplete measurement |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111427007B (en) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112069965A (en) * | 2020-08-28 | 2020-12-11 | 华中科技大学 | PIR human body tracking method and system based on orientation change |
CN112346461A (en) * | 2020-11-05 | 2021-02-09 | 上海海事大学 | Automatic guided vehicle collective filtering method considering unknown noise bounded characteristic |
CN113285461B (en) * | 2021-05-26 | 2021-11-26 | 合肥工业大学 | Power distribution network decentralized control method and system based on incomplete measurement |
CN113950018B (en) * | 2021-10-13 | 2023-10-27 | 华东理工大学 | Asynchronous multi-sensor network system and global ellipsoid state estimation method |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103237344A (en) * | 2013-04-08 | 2013-08-07 | 北京航空航天大学 | Indoor antenna sensor network positioning method based on received signal strength indication |
CN204302772U (en) * | 2014-11-19 | 2015-04-29 | 山东科技大学 | Well head elevator maintainer Intelligent safety monitor of telecommunication |
CN105717257A (en) * | 2016-03-03 | 2016-06-29 | 重庆大学 | Gas source wireless positioning method based on nonlinear least square method and extended set membership filtering |
CN108345711A (en) * | 2018-01-09 | 2018-07-31 | 山东科技大学 | Based on event driven EMU robust sensor intermittent fault detection method |
CN109597864A (en) * | 2018-11-13 | 2019-04-09 | 华中科技大学 | Instant positioning and map constructing method and the system of ellipsoid boundary Kalman filtering |
-
2020
- 2020-04-24 CN CN202010330263.4A patent/CN111427007B/en active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103237344A (en) * | 2013-04-08 | 2013-08-07 | 北京航空航天大学 | Indoor antenna sensor network positioning method based on received signal strength indication |
CN204302772U (en) * | 2014-11-19 | 2015-04-29 | 山东科技大学 | Well head elevator maintainer Intelligent safety monitor of telecommunication |
CN105717257A (en) * | 2016-03-03 | 2016-06-29 | 重庆大学 | Gas source wireless positioning method based on nonlinear least square method and extended set membership filtering |
CN108345711A (en) * | 2018-01-09 | 2018-07-31 | 山东科技大学 | Based on event driven EMU robust sensor intermittent fault detection method |
CN109597864A (en) * | 2018-11-13 | 2019-04-09 | 华中科技大学 | Instant positioning and map constructing method and the system of ellipsoid boundary Kalman filtering |
Non-Patent Citations (2)
Title |
---|
"Set membership estimation applied to the localization of small UAS in tight flight formations";J. Bolting et al.;《International Conference on Control,Automation and Systems》;20181231;全文 * |
"基于集员估计的室内移动机器人多传感器融合定位";周波 等;《控制理论与应用》;20170430;第34卷(第4期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN111427007A (en) | 2020-07-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111427007B (en) | Mine personnel safety state estimation method based on centralized personnel filtering under incomplete measurement | |
CN110244715B (en) | Multi-mobile-robot high-precision cooperative tracking method based on ultra wide band technology | |
Gumaida et al. | A hybrid particle swarm optimization with a variable neighborhood search for the localization enhancement in wireless sensor networks | |
CN101655561A (en) | Federated Kalman filtering-based method for fusing multilateration data and radar data | |
CN103648108A (en) | Sensor network distributed consistency object state estimation method | |
CN103052128A (en) | Wireless sensor network-based energy-efficient collaborative scheduling method | |
CN104090262A (en) | Moving target tracking method based on multiple-sampling-rate multiple-model fusion estimation | |
CN107064865A (en) | The passive co-located method of polar coordinates Dynamic Programming clustered based on depth | |
CN107332898A (en) | A kind of mine gas source of release localization method of Multiple Source Sensor fusion | |
CN114440895B (en) | Factor graph-based air pressure auxiliary Wi-Fi/PDR indoor positioning method | |
CN113950018B (en) | Asynchronous multi-sensor network system and global ellipsoid state estimation method | |
Jajamovich et al. | Joint multitarget tracking and sensor localization in collaborative sensor networks | |
CN103313386B (en) | Based on the radio sensing network method for tracking target of consistency on messaging right-value optimization | |
Zhou et al. | Online planning for multiagent situational information gathering in the Markov environment | |
CN103889053A (en) | Automatic establishing method of self-growing-type fingerprint | |
Zhou et al. | Hybrid niche immune genetic algorithm for fault detection coverage in industry wireless sensor network | |
Gou et al. | Three-dimensional DV-hop localization algorithm based on hop size correction and improved sparrow search | |
Wang et al. | Collaborative target tracking in WSNs using the combination of maximum likelihood estimation and Kalman filtering | |
CN109151760B (en) | Distributed state filtering method based on square root volume measurement weighting consistency | |
CN101795123A (en) | Distribution type non-linear filtering method | |
CN115220002B (en) | Multi-target data association tracking method and related device for fixed single station | |
CN115114985A (en) | Sensor system distributed fusion method based on set theory | |
CN104469782A (en) | Mobile authorized user spectrum sensing and mobile authorized user geographic position estimating method and device | |
Jia et al. | Received signal strength indicator node localization algorithm based on constraint particle swarm optimization | |
Wang et al. | Multi-Rate Data Fusion for Wireless Sensor Networks with Time-Delay Based on Improved Cubature Kalman Filter |
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 |