坐标转换c++代码

#include<iostream>
#include<fstream>
#include<iomanip>
using namespace std;
void sd(double *s,int n,ofstream &outfile);
void main()
{
int x;
double s[4]; //存储读入数据
ifstream fin("90.pts"); //打开原始数据
ofstream outfile("ldb.pts");//写出原始数据
fin>>x;
outfile<<x<<endl;
for(int i=0;i<x;i++) //读入原始数据
{
for(int j=0;j<4;j++)
{
fin>>s[j];
}
sd(s,4,outfile); //调用转换参数，进行坐标转化，并写入转换后文件
}
fin.close(); //关闭原始数据
outfile.close(); //关闭写入数据
}

void sd(double *s,int n,ofstream &outfile) //坐标转换函数
{

double d[3][3]={{-0.0968,0.9933,0.063},{-0.9950,-0.0982,0.0201},{0.0263,-0.0614,0.9978}};//坐标系转化矩阵
double a[3]={-8.3491,2.0209,0.0068};//坐标系平移参数
double b[3];
b[0]=d[0][0]*(*s)+d[0][1]*(*(s+1))+d[0][2]*(*(s+2))+a[0];
b[1]=d[1][0]**(s)+d[1][1]**(s+1)+d[1][2]**(s+2)+a[1];
b[2]=d[2][0]**(s)+d[2][1]**(s+1)+d[2][2]**(s+2)+a[2];//计算转换后坐标
outfile.precision(6);
outfi
le<<b[0]<<" "<<b[1]<<" "<<b[2]<<" "<<*(s+3)<<endl;//输出转换后坐标

}