Change particle filter variance alteration algorithm.
Ian Kuo's method causes large variance at the beginning and soon no points left.
I come up with another method, which alter the variance by the mean of diff, and limit the alteration range to prevent extreme values.