坐标系转换

根据此图：
1.已知P在XY坐标系下的坐标，X0,Y0,θ的值，可以算出P在X0Y0坐标系下的值
2.已知P在XY和X0Y0下的坐标，根据多组值便可算出两个坐标系之间的转换关系

            //UF原点坐标及旋转
            double x0 = 281.321;
            double y0 = 440.215;
            double rz = -1.583;
			
			//大地下坐标
            double x = 259.001;
            double y = 397.852;

			//大地下转换为UF下
            double x1 = (x - x0) * Math.Cos(rz * Math.PI / 180) + (y0 - y) * Math.Sin(rz * Math.PI / 180);
            double x2=(x - x0)*Math.Sin(rz * Math.PI / 180) -(y0-y)*Math.Cos(rz * Math.PI / 180);

            MessageBox.Show("x1:"+x1.ToString()+";x2:"+x2.ToString());