|
Algorithm 2. IPF algorithm for 3D emitter location using azimuth and elevation measurements. |
| 1. If at least a single pulse is emitted by the threat source and the first azimuth and elevation measurements, and , are available, solve Equations (15)–(25) to determine the cuboid search space, where ; |
| 2. Generate a set of particles uniformly distributed within the cuboid search space, according to Equations (33)–(35); |
| 3. Compute azimuth and elevation angle predictions, i.e., and , for each particle, , according to Equations (29) and (30), where ; |
| 4. Compute the weight, , of each particle, , according to Equation (31); |
| 5. Obtain the first estimate of the emitter location, , by Equation (32); |
| 6. If more measurements are available, i.e.,
|
| 7. Test whether the recent emitter location estimate, , is within the new cuboid search space determined by Equations (15)–(25); |
| 8. If the test is positive, move the center of the search cuboid to , and generate a set of particles uniformly distributed within the cuboid search space, according to Equations (36)–(38); |
| 9. If the test failed in any of the directions, the particles are generated within the cuboid search space in the respective direction according to the corresponding distribution, from Equations (33)–(35); |
| 10. Execute steps 3–5, where . |