修改gpsC++代码，已经实现5次以内收敛，没加不可逆的判断。