Summary of the invention
The object of the invention is to for the existing deficiency based on sensor array location technology, a kind of burning things which may cause a fire disaster localization method based on sensor array and dynamic optimization is provided.
First the inventive method is converted into the temperature signal gathering in sensor array position angle and estimates; Then utilize mathematical statistics method calculating sensor array to merge angle estimated value and variance thereof; Then try to achieve the border vertices coordinate of burning things which may cause a fire disaster locating area according to cartesian geometry knowledge; Finally set up dynamic optimization objective function according to border vertices coordinate information, utilize protruding optimization tool CVX to calculate the position of burning things which may cause a fire disaster.Specifically comprise the following steps:
Step 1: build sensor array group
Arrange two array of temperature sensor A and B, each array is made up of 4 negative temperature coefficient temperature sensors respectively; Two sensor array A and B are arranged in to the position that ceiling any side in room is kept to the side, and distance is L.
Step 2: temperature signal collection and pre-service
Adopt far field positioning principle, array A and array B are converted into angle estimation by the temperature signal collecting respectively
with
variance is respectively
with
wherein k is discrete time mark.
Step 3: determine burning things which may cause a fire disaster locating area border vertices coordinate
Utilize the angle estimation result of array A and array B, burning things which may cause a fire disaster can be positioned in a quadrilateral area.Adopt analytic geometry method to solve the coordinate (x on each summit
i, y
i), wherein i=1,2,3,4.
Step 4: set up dynamic optimization objective function
If the source point coordinate that fire occurs is (x
s, y
s), effectively evaluated error radius is R.According to the border vertices coordinate (x obtaining in step 3
i, y
i), can set up dynamic optimization objective function is minR
2, constraint condition is: (x
s-x
i)
2+ (y
s-y
i)
2≤ R
2, (i=1,2,3,4), wherein min represents minimization function.
Step 5: utilize the optimization problem of setting up in CVX kit solution procedure 4, and export net result.
Beneficial effect of the present invention: traditional localization method need first be estimated burning things which may cause a fire disaster coordinate, then utilizes angular bisector method further to solve error range.The method based on dynamic optimization that the present invention proposes can be calculated burning things which may cause a fire disaster source point coordinate and positioning error radius simultaneously.Therefore,, compared to traditional localization method, new method more rationally effectively.
Embodiment
Below in conjunction with drawings and Examples, the present invention will be further described.
Burning things which may cause a fire disaster positioning principle based on dual sensor array as shown in Figure 1.Array A and array B form by 4 negative temperature coefficient sensors.Suppose that in array, the distance between each sensor is less than the distance L between array, also much smaller than the distance between array and burning things which may cause a fire disaster.Generally speaking, sensor array is arranged in to the position of quiet wind restricted clearance ceiling one end near corner.
Burning things which may cause a fire disaster dynamic positioning method flow process based on sensor array and dynamic optimization as shown in Figure 2.In the time that fire occurs, in sensor array, the temperature signal of collection is sent to host computer processing by each temperature sensor, obtains corresponding angle estimation signal; Then utilize mathematical statistics method calculating sensor array to merge angle estimated value and variance thereof; Moreover try to achieve the border vertices coordinate of burning things which may cause a fire disaster locating area according to cartesian geometry knowledge; Then set up dynamic optimization objective function according to border vertices coordinate information; Finally utilize protruding optimization tool CVX to calculate the position of burning things which may cause a fire disaster.Below in conjunction with burning things which may cause a fire disaster positioning principle figure and this flow process, introduce in detail each implementation step.
Step 1: initial parameter is set
Coordinate figure (the x of array A is set as shown in Figure 1,
a, y
a), the coordinate figure (x of array B
b, y
b) can be expressed as (x
a+ L, y
a), select reference frame, make the coordinate figure of array A and B all be positioned at first quartile.
Step 2: temperature signal collection and pre-service
For sensor array A, adopt far field positioning principle, can convert 3 position angles estimations to by collecting temperature signal in k moment array
wherein j=1,2,3.According to mathematical statistics knowledge, estimation is merged at the position angle of array A
and variance
for
Similarly, for sensor and array B, can convert 3 position angles estimations to by collecting temperature signal in k moment array
wherein j=1,2,3.So, estimation is merged at the position angle of array B
and variance
for
Step 3: determine burning things which may cause a fire disaster locating area border vertices coordinate
As shown in Figure 1, order
Fire source point necessarily drops on quadrilateral C
1c
2c
3c
4in region.Obviously, the coordinate (x on each summit
i, y
i) (i=1,2,3,4) can solve according to analytic geometry method, detailed process is as follows:
First, make straight line l
islope be k
i, (i=1,2,3,4), have
In above formula, tan represents tan.
Summit C
1for straight line l
1and l
4intersection point, therefore (x
1, y
1) meet
Solve above-mentioned linear equation in two unknowns group, can obtain
Summit C
2for straight line l
2and l
4intersection point, therefore (x
2, y
2) meet
Solve above-mentioned linear equation in two unknowns group, can obtain
Summit C
3for straight line l
2and l
3intersection point, therefore (x
3, y
3) meet
Solve above-mentioned linear equation in two unknowns group, can obtain
Summit C
4for straight line l
1and l
3intersection point, therefore (x
4, y
4) meet
Solve above-mentioned linear equation in two unknowns group, can obtain
Step 4: set up dynamic optimization objective function
If the source point coordinate that fire occurs is (x
s, y
s), effectively evaluated error radius is R.According to the border vertices coordinate (x obtaining in step 3
i, y
i), the process that solves burning things which may cause a fire disaster coordinate and error radius can be described as following optimization problems:
minR
2
(12)
s.t.(x
s-x
i)
2+(y
s-y
i)
2≤R
2(i=1,2,3,4)
Wherein, min represents minimization function, and s.t. represents constraint condition.Obviously, the difficult non-protruding optimization problem to solve of formula (12) can be translated into 4 following protruding optimization problems of equivalence, for this reason
min(x
s-x
1)
2+(y
s-y
1)
2
(13)
s.t.(x
s-x
p)
2+(y
s-y
p)
2≤(x
s-x
1)
2+(y
s-y
1)
2(p=2,3,4)
min(x
s-x
2)
2+(y
s-y
2)
2
(14)
s.t.(x
s-x
p)
2+(y
s-y
p)
2≤(x
s-x
2)
2+(y
s-y
2)
2(p=1,3,4)
min(x
s-x
3)
2+(y
s-y
3)
2
(15)
s.t.(x
s-x
p)
2+(y
s-y
p)
2≤(x
s-x
3)
2+(y
s-y
3)
2(p=1,2,4)
min(x
s-x
4)
2+(y
s-y
4)
2
(16)
s.t.(x
s-x
p)
2+(y
s-y
p)
2≤(x
s-x
4)
2+(y
s-y
4)
2(p=1,2,3)
For the ease of utilizing CVX optimization tool direct solution, the described protruding optimization problem in formula (14)~(16) further equivalence is rewritten as:
min(x
s-x
i)
2+(y
s-y
i)
2
Step 5: solving-optimizing problem, and Output rusults.
Utilize the described optimization problem of CVX kit solution procedure 4 Chinese styles (17), the optimum solution of i optimization problem of note is
(i=1,2,3,4), error radius is
Therefore, the error radius of global optimum is
Wherein, q=1,2,3,4, thereby corresponding burning things which may cause a fire disaster coordinate is estimated as
。