initial upload

archive/sph2car/func.h

@@ -0,0 +1,115 @@
+#ifndef _FUNC_H
+#define _FUNC_H
+#include <iostream>
+#include <fstream>
+#include <sstream>
+#include <iomanip>
+#include <cmath>
+#include <string.h>
+#include <stdio.h>
+#include <stdlib.h>
+#define OUTPUT "-o"
+#define WGS84 "WGS84"
+#define RADIUS "-d"
+#define RANGE "-r"
+#define INSERT "-i"
+#define FILE "-f"
+#define pole_radius 6356752.3//WGS84椭球极半径
+#define equator_radius 6378137//WGS84椭球长半径
+#define pi 3.1415926535897932384626433832795
+using namespace std;
+
+struct point3d
+{
+	double x,y,z;
+};
+
+double WGS84_r(double lati)
+{
+	return pole_radius*equator_radius/sqrt(pow(pole_radius,2)*pow(cos((double) lati*pi/180.0),2)+pow(equator_radius,2)*pow(sin((double) lati*pi/180.0),2));
+}
+
+point3d SCS2CCS(double phi,double thet,double radius)
+{
+	point3d v;
+	v.x = radius*sin((0.5-thet/180.0)*pi)*cos((2.0+phi/180.0)*pi);
+	v.y = radius*sin((0.5-thet/180.0)*pi)*sin((2.0+phi/180.0)*pi);
+	v.z = radius*cos((0.5-thet/180.0)*pi);
+	return v;
+}
+
+int create_grid(double radius,int* interval,int* range,string outname)
+{
+	point3d posi;
+	int d_phi = *interval,d_thet = *(interval+1);
+	int xmin = *range,xmax = *(range+1),ymin = *(range+2),ymax = *(range+3);
+
+	ofstream outfile(outname.c_str());
+	if (radius==-1.0)
+	{
+		for (int i = ymin; i <= ymax; i+=d_thet)
+		{
+			for (int j = xmin; j <= xmax; j+=d_phi)
+			{
+				posi = SCS2CCS(j,i,WGS84_r(i));
+				outfile<<setprecision(16)<<posi.x<<" "<<posi.y<<" "<<posi.z<<endl;
+			}
+		}
+		outfile.close();
+	}
+	else
+	{
+		for (int i = ymin; i <= ymax; i+=d_thet)
+		{
+			for (int j = xmin; j <= xmax; j+=d_phi)
+			{
+				posi = SCS2CCS(j,i,radius);
+				outfile<<setprecision(16)<<posi.x<<" "<<posi.y<<" "<<posi.z<<endl;
+			}
+		}
+		outfile.close();
+	}
+	
+	return 0;
+}
+
+int add_grid(double radius,string input_name,string output_name)
+{
+	point3d posi;
+	string temp;
+	stringstream stemp;
+	double temp_phi,temp_thet,temp_radius;
+	ifstream infile(input_name.c_str());
+	ofstream outfile(output_name.c_str());
+	if (!infile)
+	{
+		cout<<input_name<<" not found, program stopped..."<<endl;
+		return 1;
+	}
+	else
+	{
+		while(getline(infile,temp)) {
+			if (temp!="")
+			{
+				stemp.clear();
+		    	stemp.str(temp);
+		    	stemp>>temp_phi>>temp_thet>>temp_radius;
+			}
+		   
+			if (radius==-1.0)
+			{
+				posi = SCS2CCS(temp_phi,temp_thet,WGS84_r(temp_thet)+temp_radius);
+				outfile<<setprecision(16)<<posi.x<<" "<<posi.y<<" "<<posi.z<<endl;
+			}
+			else
+			{
+				posi = SCS2CCS(temp_phi,temp_thet,radius+temp_radius);
+				outfile<<setprecision(16)<<posi.x<<" "<<posi.y<<" "<<posi.z<<endl;
+			}
+		}
+		infile.close();
+		outfile.close();
+	}
+	return 0;
+}
+#endif