trilateral 该算法为三边定位算法，通过移动点和三个基站点之间的距离和坐标，计算出移动点的坐标。 由于需要移植到ROS平台，因此将源文件定义cpp文件，其实现代码由C语言实现，可用vs打开该项目进行调试。