• 定位算法

定位算法

1. 求两点之间直线的角度

2. 求一个点(X1,Y1)围绕另一个点(Xc,Yc)旋转角度θ后的新坐标(x,y) 参考：https://blog.csdn.net/brilliantyoho/article/details/17242049?spm=1001.2101.3001.6650.1&utm_medium=distribute.pc_relevant.none-task-blog-2%7Edefault%7ECTRLIST%7Edefault-1-17242049-blog-67639864.pc_relevant_aa_2&depth_1-utm_source=distribute.pc_relevant.none-task-blog-2%7Edefault%7ECTRLIST%7Edefault-1-17242049-blog-67639864.pc_relevant_aa_2&utm_relevant_index=2

   公式： x = (x1 - x2)cos(θ) - (y1 - y2)sin(θ) + x2 ; y = (x1 - x2)sin(θ) + (y1 - y2)cos(θ) + y2 ;