空间直角坐标系与球面坐标互转

空间直角坐标系与球面坐标互转

using System;
using System.Collections.Generic;
using System.Linq;
using System.Text;

namespace AppSurveryTools.SphericalAndCartesian
{
    class CartesianCoord
    {
        public double x;
        public double y;
        public double z;

        private static CartesianCoord temp = CartesianCoord.ZERO;

        public CartesianCoord(double x = 0, double y = 0, double z = 0)
        {
            this.x = x;
            this.y = y;
            this.z = z;
        }

        public CartesianCoord clone()
        {
            return new CartesianCoord(this.x, this.y, this.z);
        }

        public void copyTo(CartesianCoord n)
        {
            n.x = this.x;
            n.y = this.y;
            n.z = this.z;
        }

        public void copyFrom(CartesianCoord n)
        {
            this.x = n.x;
            this.y = n.y;
            this.z = n.z;
        }

        public void reset(double newx = 0, double newy = 0, double newz = 0)
        {
            this.x = newx;
            this.y = newy;
            this.z = newz;
        }

        public static CartesianCoord ZERO
        {
            get
            {
                return new CartesianCoord(0, 0, 0);
            }
        }
    }
}

namespace AppSurveryTools.SphericalAndCartesian
{
    public class SphericalCoord
    {
        public double radius;
        public double theta;
        public double phi;

        private static SphericalCoord temp = SphericalCoord.ZERO;

        public SphericalCoord(double radius, double theta = 0, double phi = 0)
        {
            this.radius = radius;
            this.theta = theta;
            this.phi = phi;
        }

        public SphericalCoord clone()
        {
            return new SphericalCoord(this.radius, this.theta, this.phi);
        }

        public void copyTo(SphericalCoord n)
        {
            n.radius = this.radius;
            n.theta = this.theta;
            n.phi = this.phi;
        }

        public void copyFrom(SphericalCoord n)
        {
            this.radius = n.radius;
            this.theta = n.theta;
            this.phi = n.phi;
        }

        public void reset(double newradius = 0, double newtheta = 0, double newphi = 0)
        {
            this.radius = newradius;
            this.theta = newtheta;
            this.phi = newphi;
        }

        public static SphericalCoord ZERO
        {
            get
            {
                return new SphericalCoord(0, 0, 0);
            }
        }
    }
}

using System;
using System.Collections.Generic;
using System.Linq;
using System.Text;

namespace AppSurveryTools.SphericalAndCartesian
{
    class CoordsTransform
    {
        public CoordsTransform()
        {
        }

        public SphericalCoord CartesianToSpherical(CartesianCoord coord)
        {
            var radius = this.GetModuloFromCartesianCoord(coord);
            var theta = this.GetThetaFromCartesianCoord(coord);
            var phi = this.GetPhiFromCartesianCoord(coord);
            return new SphericalCoord(radius, theta, phi);
        }
        /// <summary>
        /// 获取空间直角坐标空间中模，径向距离
        /// </summary>
        /// <param name="coord"></param>
        /// <returns></returns>
        protected double GetModuloFromCartesianCoord(CartesianCoord coord)
        {
            return Math.Sqrt(coord.x * coord.x + coord.y * coord.y + coord.z * coord.z);
        }
        /// <summary>
        /// Theta角，天顶角
        /// </summary>
        /// <param name="coord"></param>
        /// <returns></returns>
        protected double GetThetaFromCartesianCoord(CartesianCoord coord)
        {
            //return Math.atan(Math.sqrt(coord.x*coord.x + coord.y*coord.y)/coord.z);
            return Math.Acos(coord.z / this.GetModuloFromCartesianCoord(coord));
        }
        /// <summary>
        /// 获取phi角，方位角
        /// </summary>
        /// <param name="coord"></param>
        /// <returns></returns>
        protected double GetPhiFromCartesianCoord(CartesianCoord coord)
        {
            return Math.Atan(coord.y / coord.x);
        }

        public CartesianCoord SphericalToCartesian(SphericalCoord coord)
        {
            var x = this.GetXFromSphericalCoord(coord);
            var y = this.GetYFromSphericalCoord(coord);
            var z = this.GetZFromSphericalCoord(coord);
            return new CartesianCoord(x, y, z);
        }
        //球面坐标计算X坐标
        protected double GetXFromSphericalCoord(SphericalCoord coord)
        {
            return coord.radius * Math.Sin(coord.theta) * Math.Cos(coord.phi);
        }
        //球面坐标计算Y坐标
        protected double GetYFromSphericalCoord(SphericalCoord coord)
        {
            return coord.radius * Math.Sin(coord.theta) * Math.Sin(coord.phi);
        }
        //球面坐标计算Z坐标
        protected double GetZFromSphericalCoord(SphericalCoord coord)
        {
            return coord.radius * Math.Cos(coord.theta);
        }
    }
}

调用代码

  private void btnCartesianToSpherical_Click(object sender, EventArgs e)
        {
            CoordsTransform CoordTrans = new CoordsTransform();
            double x = (double)numX.Value;
            double y = (double)numY.Value;
            double z = (double)numZ.Value;
            CartesianCoord vCartesianCoord = new CartesianCoord(x, y, z);
            SphericalCoord ResSphericalCoord = CoordTrans.CartesianToSpherical(vCartesianCoord);
            numRadius.Value = (decimal)ResSphericalCoord.radius;
            numPhi.Value = (decimal)ResSphericalCoord.phi;
            numAmith.Value = (decimal)ResSphericalCoord.theta;
        }

        private void btnSphericalToCartesian_Click(object sender, EventArgs e)
        {
            CoordsTransform CoordTrans = new CoordsTransform();
            double radius = (double)numRadius.Value;
            double phi = (double)numPhi.Value;
            double theta = (double)numAmith.Value;
            SphericalCoord vSphericalCoord = new SphericalCoord(radius, theta, phi);
            CartesianCoord ResCartesianCoord = CoordTrans.SphericalToCartesian(vSphericalCoord);
            numX.Value = (decimal)ResCartesianCoord.x;
            numY.Value = (decimal)ResCartesianCoord.y;
            numZ.Value = (decimal)ResCartesianCoord.z;
        }

参考文献：

http://www.cnblogs.com/hans_gis/archive/2012/11/21/2755126.html