Skip to main content
. 2020 Mar 2;20(5):1371. doi: 10.3390/s20051371
Algorithm 3. UKF algorithm
Step (1): Let k = 1, initialize each radar transmit power Pq,ki, target state ξq,k1|k1 and covariance matrix Cq,k1|k1=J1(ξq,k1|k1).
Step (2): The transmitting power of each radar is Pq,ki, get the measured value zq,k of the target, and calculate Σq,k.
Step (3): Construct the 2L + 1 sigma point set χq,k1|k1i and the weights ωi,k corresponding to the point set according to the following formula.
{χq,k1|k10=ξq,k1|k1χq,k1|k1i=ξq,k1|k1+((I+ς)Cq,k1|k1)ii=1,2,,Iχq,k1|k1i=ξq,k1|k1((I+ς)Cq,k1|k1)iIi=I+1,I+2,,2I
{ω0,k=ςI+ςωi,k=I2(I+ς)i=1,2,,2I
Where, ς is a scale factor, ((I+ς)Cq,k1|k1)i represents the ith column of the square root (I+ς)Cq,k1|k1 of the matrix; I represents the dimension of the state vector.
Step (4): Map the sigma point set χq,k1|k1i to the predicted point set χq,k|k1i through the state transition function Fq, and calculate the new target state ξq,k|k1 and variance Cq,k|k1 by weighting.
χq,k|k1i=Fq×χq,k1|k1i
{ξq,k|k1=i=02I(ωi,k×χq,k|k1i)Cq,k|k1=i=02Iωi,k(χq,k|k1iξq,k|k1)(χq,k|k1iξq,k|k1)T+Qq,k1
Step (5): Map the sigma prediction point set χq,k|k1i to the new point set zq,k|k1i through the measurement equation, and calculate the mean zq,k|k1, variance Cq,kzz and Cq,kxz.
zq,k|k1i=g(χq,k|k1i)
{zq,k|k1=i=02I(ωi,k×zq,k|k1i)Cq,kzz=i=02Iωi,k(zq,k|k1izq,k|k1)(zq,k|k1izq,k|k1)T+Σq,kCq,kzz=i=02Iωi,k(χq,k|k1iξq,k|k1)(χq,k|k1iξq,k|k1)T
Step (6): Calculate the gain matrix Kq,k and update ξq,k|k1 and covariance Cq,k|k matrix with the gain matrix.
{Kq,k=Cq,kxz×(Cq,kzz)1ξq,k|k=ξq,k|k1+Kq,k(zq,kzq,k|k1)Cq,k|k=Cq,k|k1Kq,k×Cq,kzz×(Kq,k)T
Step (7): According to the intelligent hybrid algorithm proposed above, predict the radar transmission power pk+1,opti at the kth moment, let k=k+1 and then jump to step (2)