pso_icp algorithm for hand tracking