Based on the comparison of different algorithms of energy,we create a target function, and use grads method to realize localization.

• 本文在比较基于能量的各种算法的基础上提出了建立目标函数,用梯度法实现定位的算法。