基于C#实现卫星坐标计算与单点定位
性能需求
（1）硬件需求：这一软件是开发在个人电脑上的，并且运行也需要在电脑上。其中为保证运行顺畅，CPU最好在i5以上或者AMD 锐龙5，内存最好在4G以上，显卡NVIDIA GeForce MX110即可，存储空间300M。
（2）软件需求：这一软件在Windows下面开发，开发环境是Visual Studio2017，开发语言是C#.NET。故运行也需要在Windows下进行，并且电脑安装有Visual Studio2013及以上版本，其中C#.NET的框架是.NET Framework 4.6.1。对于数据库要求，需要安装SQL sever2016及以上版本，确保数据库运行。
功能需求
日前，我国的北斗全球卫星定位系统已经完成全球组网。这标志着我国拥有了自己的卫星定位系统。如何利用卫星进行精确定位是一项重要课题。这一软件从卫星定位原理出发，简单地实现了通过卫星的星历数据，计算卫星坐标，通过单点定位的方法，求得地面待测点的三维坐标。
这一软件的功能如上图1-1所示，包括读取卫星的广播星历文件，通过星历计算卫星某一时刻的三维坐标，批量时刻点和多颗卫星计算，以及通过单点定位的方法实现对地面点进行三维坐标测算。
功能模块设计
文件读取模块
数据原始文件是从IGS官网（网址：http://garner.ucsd.edu/pub/nav/）下载得到的广播星历文件用来计算卫星坐标，从相关网站上（网址：http://garner.ucsd.edu/pub/misc/BatCaves/0001024c.06o）下载了单点定位要用的观测值文件。文件编码格式采用的是UTF-8的格式。故而直接编写读取文件的程序将其读进来，并把他们中用于计算的参数存入到卫星参数数据库中。在卫星参数数据库里，每一行代表某一个卫星在某时刻的各个参数。在参数分割中，需要处理广播星历的文件，如图2-2所示。其中“END OF HEADER”以上的信息是星历信息，在本题中不需要，故需要从“END OF HEADER”下面开始搜索有用信息。例如要求计算2008年5月14日02点0分00秒—20分00秒，每隔1分钟的PRN2的坐标的轨道坐标，只需提取第一列是2（卫星号），对应行是“08 5 14 2 0”（对应时间）即可。
卫星坐标计算模块
单点定位计算模块
类设计
对于这一程序，我设计了五个类，其中两个计算类，分别用于计算卫星坐标和单点定位坐标求解。三个数据库操作类，DataBase是基类，包含数据库的基本操作：查找、显示、删除、添加、修改等，派生出两个子类用于处理卫星坐标数据库和地面点坐标数据库。
详细设计
文件读取模块设计
对于文件读取，我大致在程序中分为了三个步骤：打开文件，切割字符串和将参数存入到数据库。
在打开文件中我使用了openfiledialog对话框，以便在提示下打开要用的文件，并将文件中的内容读入到字符串中。
OpenFileDialog pdlg = new OpenFileDialog();
pdlg.Filter = "所有文件|*.*";
DialogResult rt = pdlg.ShowDialog();
if (rt == DialogResult.OK)
{
string filename = pdlg.FileName;
info = File.ReadAllLines(filename);
}
在切割字符串过程中，根据2.1.1所介绍的规则进行分割，此处由于数据并不是严格以空格或者其他方式分隔，所以，我利用正则表达式将有用的数据提取出来。
for (ii = 0; ii < row-1; ii++)
{
find = info[ii];
find = find.Trim();
if (find == "END OF HEADER")
break;
}
for(ii=ii+1;ii<row;ii=ii+8)
{
Canshu canshu;
int i = ii;
string iline =info[i];
Regex re = new Regex(@"(\d+(\.\d+)?)");
MatchCollection iarray = re.Matches(iline);
double[,] all = new double[7, 4];
string[] starray = new string[7]; int m = 0;
for (int k = i + 1; k < i + 8; k++, m++)
{
iline = info[k];
starray[m] = iline;
}
string stallof = "";
foreach (string strs in starray)
{
stallof = stallof + strs;
}
Regex p = new Regex(@"(-??\d?[.]\d{12}['D'][+-]\d\d)");
MatchCollection collection = p.Matches(stallof);
double[] alls = new double[28];
for (int n = 0; n < 25; n++)
{
string[] temst = collection[n].Value.Split('D');
alls[n] = double.Parse(temst[0]) * Math.Pow(10, double.Parse(temst[1]));
}
卫星坐标计算模块设计
对于卫星坐标计算，我设计了一个计算类，通过有参数的构造函数把对应的卫星序号和时间传进来进行计算。计算中我分为了两类：一类是根据星历可以直接求得的卫星坐标，这种坐标是精度比较高的；一类是需要根据星历求得临近时刻的卫星坐标，这种坐标精度低一些。这两类首先都需要先把输入的时间转换为对应的GPS周秒形式。
对于第一类卫星，直接通过从卫星参数数据库找到相应值，根据2.1.2介绍的原理，计算卫星三维坐标。
对于第二类卫星坐标的求解，我们需要先判断这一卫星距离哪一个通过星历计算出的位置近，并取这一星历数据作为起算数据，后续过程与第一类大致相同。
数据库模块设计
在数据库设计中，我利用类的继承与重写等面向对象的机制，设计了一个父类，两个子类，实现对卫星参数数据库、卫星坐标数据库和地面坐标数据库的管理。在数据库的类中，利用构造函数连接数据库，这样只要调用时就可以自动连接。
对于查找操作，通过连接数据库，向SQL中传入查询语句，并将返回值保存到DataSet类型中，最后通过窗体台中的DataGridView控件显示查找值。
单点定位计算模块设计
对于单点定位的程序设计，大致根据2.1.3介绍的数学模型进行设计。首先先判断卫星数与4比的大小。如果大于4，则需要用最小二乘求解改正值；如果等于4，则利用线性方程直接求解；如果小于4，则无法计算。过程中需要矩阵的运算，在这里我运用了之前写过的矩阵运算类解决求逆，转置等问题。
界面设计
对于这一程序，我选择了如图3-1所示的单文档界面，通过tabControl控件，把“查看修改卫星参数”、“卫星坐标计算与查看”、“单点定位”分隔开，让每一个成单独的部分。在每一部分中，使用splitContainer把页面隔成输入输出两个模块，其中，由于在第一部分的输入类型有多种，故使用GroupBox控件分组管理。这一界面设计方式能够减少文件窗口，操作简单，而且可读性可观性较好。
首先是标签栏设计。如图所示，通过“文件->打开”，可以实现打开文件操作。通过“文件->分割字符串”可以实现分割字符串，从文件内容中提取有用的参数，并存入到内存中。通过“文件->参数装入数据库”可实现把内存中的参数集合存入到卫星参数数据库中，方便之后的步骤使用。通过“文件->保存为文本文档”可以实现把卫星坐标的内容存为文本文件，方便之后精度对比。
对于第一页，都涉及通过界面输入向内部传值，此过程涉及到字符串分割，尤其是使用dateTimePicker控件中的值，先需要通过ToShortDateString和ToLongTimeString把时间转换成字符串格式，通过字符串切割取出时间参数。在修改模块中，运用comBox控件，实现让用户通过下拉列表选择修改的属性。
对于第二页卫星坐标计算与查看，如图3-3和3-4所示，利用radioButton控件选择计算类型，从而选择对应的函数进行调用。在这一过程中，为了增强程序的健壮性，提升容错能力，当用户没有勾选计算类型的时候，会弹出如图3-5的输入警示图；当用户有一些必要参数没有输入的时候，会弹出如图3-6的警示图。在计算完成后，结果会显示在下方的DataGridView控件中，其中多卫星多时刻计算时，输出的结果是每隔一分钟输出一个卫星坐标。
对于第三页，如图3-6所示，通过DateTimePick控件实现选择观测的日期和时间，并通过textbox输入近似值的坐标，即可通过调用计算类方法计算出该地面点的三维坐标，最终将结果输入到地面点数据库和DataGridView控件中。
调试分析与测试结果
文件读取功能模块调试分析
本程序读取的文件是卫星的广播星历，文件编码格式是“utf-8”，文件的后缀是.XXn，其中XX代表年份，n表示广播星历，例如本测试数据文件后缀是：.08n代表是2008年的广播星历数据。这一数据来源是从IGS网站下载得来。
在切割字符串后弹出如图4-1所示的提示框，说明切割成功。如图4-2所示是参数装入SQL sever中的显示，由此可知，数据入库成功。
卫星坐标计算模块调试分析
如图4-3是对星历文件中包含的卫星指定时刻的卫星坐标计算。我们可以通过直接把结果与精密星历对比。拿2008年5月14日2时0分0秒做对比，结果如表4-1。
如表4-1所示，我们可以看到通过广播星历计算得到的坐标值与精密星历之间的误差在米级，符合精度的要求，所以本程序测试通过。
批量时刻点和多颗卫星计算。我们可以利用之前的精密星历与各个计算结果进行比较绘制出如图4-5所示的误差图。
我利用python语言，把通过精密星历得到的坐标作为标准坐标，与通过广播星历得到的坐标做中误差计算。并分别绘制了两颗卫星，不同时刻的点位中误差图，我们发现，其误差在米级，符合规定要求，因此测试通过。
数据库模块调试分析
查看功能：在输入框内输入测试值，查询结果如图4-6所示。可以看到我们可以显示出这一条信息的数值。
修改功能：在输入框内输入修改的地方，选择修改的属性，输入修改后的值，修改结果如图4-7所示，我们可以看到这一条信息的“crs”值已被修改。
删除功能：在输入框内输入删除的地方，删除结果如图4-7所示，我们可以看到，当再次执行查看操作时，删除的那一条信息已经没有了，由此删除成功。
操作使用说明
在第一次处理某一星历的时候，需要首先打开文件（文件->打开），接着切割字符串（文件->分割字符串），等到弹出“OK”对话框后，再把参数存入数据库（文件->参数装入数据库）。这时，我们可以点击“查看”按钮浏览一下分割后的结果。
这一程序有三个板块。第一个板块是对已经得到的卫星参数数据库做查看，修改，删除操作。实现灵活处理数据库的功能。
单击“卫星坐标计算与查看”进入第二板块，可以点击单卫星计算，输入卫星序号和时间，可以直接计算并显示出该点的三维坐标，并存入到数据库中，作为计算日志。如图5-2 单卫星计算图。当点击多卫星多时刻计算时，在卫星序号输入栏里输入卫星号，并用逗号隔开，在时间栏里输入起止时间，点击计算，将会输出每隔一分钟的卫星坐标，如图5-3 多卫星多时刻计算图。在计算完成后还可以通过“文件->保存为文本文档”将计算查询结果保存为文本文件，这实现了数据文件存储和数据库存储双重存储。
最后，点击“单点定位”进入第三板块，如图5-4 单点定位窗口图，通过选择日期和时间，输入测站的近似坐标，单击单点定位，即可通过搜索可用的卫星星历，计算可视的卫星坐标，进而得到地面点坐标，最终保存并显示到下方表格中。
代码
类代码
using System;
using System.Collections.Generic;
using System.Linq;
using System.Text;
using System.Threading.Tasks;
using System.Data.SqlClient;
using System.Data;
using MathNet.Numerics.LinearAlgebra.Double;
using MathNet.Numerics.LinearAlgebra;
namespace GPS卫星坐标与单点定位计算
{
/// using System;
using System.Collections.Generic;
using System.Linq;
using System.Text;
using System.Threading.Tasks;
namespace GPS卫星坐标与单点定位计算
{
class Matrix
{
///
/// 矩阵的转置
///
///
public static double[,] Transpose(double[,] iMatrix)
{
int row = iMatrix.GetLength(0);
int column = iMatrix.GetLength(1);
//double[,] iMatrix = new double[column, row];
double[,] TempMatrix = new double[row, column];
double[,] iMatrixT = new double[column, row];
for (int i = 0; i < row; i++)
{
for (int j = 0; j < column; j++)
{
TempMatrix[i, j] = iMatrix[i, j];
}
}
for (int i = 0; i < column; i++)
{
for (int j = 0; j < row; j++)
{
iMatrixT[i, j] = TempMatrix[j, i];
}
}
return iMatrixT;
}
///
/// 矩阵的逆矩阵
///
///
public static double[,] Athwart(double[,] iMatrix)
{
int i = 0;
int row = iMatrix.GetLength(0);
double[,] MatrixZwei = new double[row, row * 2];
double[,] iMatrixInv = new double[row, row];
for (i = 0; i < row; i++)
{
for (int j = 0; j < row; j++)
{
MatrixZwei[i, j] = iMatrix[i, j];
}
}
for (i = 0; i < row; i++)
{
for (int j = row; j < row * 2; j++)
{
MatrixZwei[i, j] = 0;
if (i + row == j)
MatrixZwei[i, j] = 1;
}
}
for (i = 0; i < row; i++)
{
if (MatrixZwei[i, i] != 0)
{
double intTemp = MatrixZwei[i, i];
for (int j = 0; j < row * 2; j++)
{
MatrixZwei[i, j] = MatrixZwei[i, j] / intTemp;
}
}
for (int j = 0; j < row; j++)
{
if (j == i)
continue;
double intTemp = MatrixZwei[j, i];
for (int k = 0; k < row * 2; k++)
{
MatrixZwei[j, k] = MatrixZwei[j, k] - MatrixZwei[i, k] * intTemp;
}
}
}
for (i = 0; i < row; i++)
{
for (int j = 0; j < row; j++)
{
iMatrixInv[i, j] = MatrixZwei[i, j + row];
}
}
return iMatrixInv;
}
///
/// 矩阵加法
///
///
///
public static double[,] AddMatrix(double[,] MatrixEin, double[,] MatrixZwei)
{
double[,] MatrixResult = new double[MatrixEin.GetLength(0), MatrixZwei.GetLength(1)];
for (int i = 0; i < MatrixEin.GetLength(0); i++)
for (int j = 0; j < MatrixZwei.GetLength(1); j++)
MatrixResult[i, j] = MatrixEin[i, j] + MatrixZwei[i, j];
return MatrixResult;
}
///
/// 矩阵减法
///
///
///
public static double[,] SubMatrix(double[,] MatrixEin, double[,] MatrixZwei)
{
double[,] MatrixResult = new double[MatrixEin.GetLength(0), MatrixZwei.GetLength(1)];
for (int i = 0; i < MatrixEin.GetLength(0); i++)
for (int j = 0; j < MatrixZwei.GetLength(1); j++)
MatrixResult[i, j] = MatrixEin[i, j] - MatrixZwei[i, j];
return MatrixResult;
}
///
/// 矩阵乘法
///
///
///
public static double[,] MultiplyMatrix(double[,] MatrixEin, double[,] MatrixZwei)
{
double[,] MatrixResult = new double[MatrixEin.GetLength(0), MatrixZwei.GetLength(1)];
for (int i = 0; i < MatrixEin.GetLength(0); i++)
{
for (int j = 0; j < MatrixZwei.GetLength(1); j++)
{
for (int k = 0; k < MatrixEin.GetLength(1); k++)
{
MatrixResult[i, j] += MatrixEin[i, k] * MatrixZwei[k, j];
}
}
}
return MatrixResult;
}
///
/// 矩阵对应行列式的值
///
///
///
public static double ResultDeterminant(double[,] MatrixEin)
{
return MatrixEin[0, 0] * MatrixEin[1, 1] * MatrixEin[2, 2] + MatrixEin[0, 1] * MatrixEin[1, 2] * MatrixEin[2, 0] + MatrixEin[0, 2] * MatrixEin[1, 0] * MatrixEin[2, 1]
- MatrixEin[0, 2] * MatrixEin[1, 1] * MatrixEin[2, 0] - MatrixEin[0, 1] * MatrixEin[1, 0] * MatrixEin[2, 2] - MatrixEin[0, 0] * MatrixEin[1, 2] * MatrixEin[2, 1];
}
}
}
窗口代码
using System;
using System.Collections.Generic;
using System.ComponentModel;
using System.Data;
using System.Drawing;
using System.Linq;
using System.Text;
using System.Threading.Tasks;
using System.Windows.Forms;
using System.Data.SqlClient;
using System.Data;
using System.IO;
using System.Text.RegularExpressions;
namespace GPS卫星坐标与单点定位计算
{
public partial class Form1 : Form
{
List<Canshu> cslist = new List<Canshu>();
string[] info = null;
public Form1()
{
InitializeComponent();
}
private void label2_Click(object sender, EventArgs e)
{
}
private void splitContainer2_Panel1_Paint(object sender, PaintEventArgs e)
{
}
/// SQL建表
use canshubase
go
create table wxc
(
prn int not null,
year int ,
month int,
day int,
hour int,
minute int,
second float,
a float,
dn float,
t0 float,
m0 float,
e float,
omega float,
cuc float,
cus float,
crc float,
crs float,
cic float,
cis float,
idot float,
i0 float,
bigomega float,
bigomegadot float,
)
go
use wxcanshu
go
create table xyz
(
prn int not null,
year int ,
month int,
day int,
hour int,
minute int,
second float,
x float,
y float,
z float,
)
go
use canshu
go
TRUNCATE TABLE xyz
go
select * from xyz
go
create table cz
(
x float,
y float,
z float
)
反思
调试完程序，编写完实习报告。为期五天的测绘编程实习终于告一段落。回顾这五天，时不时通宵修改代码。虽然辛苦，但是也是深有体会。也对自己之后的编程有了一定的教训。
首先之后拿到编程任务的时候不要忙着开始写程序，一定要写理清楚题目要求得的东西，程序要实现的功能，如果有窗体的话，规划窗体如何设计，要设置几个类，类与类之间的关系。把必要的计算过程理顺，绘制出流程图，然后再着手写程序。
编写程序的时候尽量用面向对象的思路设计，一定避免某一个地方好几百行程序，一定要用函数，减少程序的耦合度。一定要减少代码的冗余度，重复的代码一定要放在函数里，最好是封装到类里。
一定要增强程序的健壮性，通过提示，或者增加多种情况讨论来减少由于错误数据传入带来程序的崩掉。在代码编写的过程，一定要加注释，C#在对方法或者类注释的时候在前面打三个“/”就可以产生能够生成一个XML文件的注释形式，这一形式可以在调用的时候有提示。
再有就是对数组，列表等遍历的时候，一定考虑超限的问题。
http://garner.ucsd.edu/pub/
多数可以匿名登录，用户名：anonymous，密码：自己的Email地址
met 有M文件
nav 有N文件
http://garner.ucsd.edu/pub/misc/BadData/ 有o文件
StarUML类图绘制