Algorithm 2 Support vector learning-based particle filter algorithm |
-
1:
Initialization: generate initial particles and give them uniform weights
-
2:
for all
do
-
3:
for all
do
-
4:
- Draw particles according to state transition model (4)
-
5:
-
6:
- Compute the observation according to the Algorithm 1
-
7:
-
8:
- Compute the likelihood function based on (30):
-
9:
- Update the weights based on (31):
-
10:
end for
-
11:
- Obtain total particle weights
-
12:
- Normalize the weight:
-
13:
- Resample the particles according to the weights :weed out low-weight particles
-
14:
- Estimate the target state
-
15:
end for
|