Rotate ply. Copy and modify codes from Ian Kuo into ParticleFilter.update(). Use x_pos and y_pos sum of two distance as evaluation. Work but particle disappear after several times of update. Needs fix.