資源簡介
GPS衛(wèi)星單點(diǎn)定位程序-利用偽距-精度在10m左右

代碼片段和文件信息
#include
#include
#include
#include
#include
#include
#include“mystruct.h“
#include“readNfile.h“
#include“matrix.h“
//以下矩陣要用------------------
using?namespace?std;???????????//
#ifndef?_NO_NAMESPACE??????????//
using?namespace?math;??????????//
#define?STD?std????????????????//
#else??????????????????????????//
#define?STD????????????????????//
#endif?????????????????????????//
???????????????????????????????//
#ifndef?_NO_TEMPLATE???????????//
typedef?matrix?Matrix;?//?
#else??????????????????????????//
typedef?matrix?Matrix;?????????//?
#endif//-------------------------
time_gps?GregToGps(time_calendar?tc);//聲明時(shí)間轉(zhuǎn)換
//////////////////////--------------主函數(shù)開始-----------------
int?main()
{
//----------------------Read?N?File---------------------------------
????vector?vn;
readNfile(vn);
cout<<“N文件循環(huán)vn.size=“< ????cout<<“-------------n?file?is?ok-----------“< //----------------------Read?O?File----------------------------------
????vector?v;double?apxapyapz;
readOfile(vapxapyapz);
cout<<“v.size=“< ????cout<<“-------------o?file?is?ok-----------“< //------------------------開始計(jì)算------------------------------- ???
double?const?pi=3.1415926535898;
double?const?c=2.99792458e8;//光速
int?poskepc=0j=0;//posk最近信息位置,epc=第epc歷元
double?tstr;//tr衛(wèi)星信號(hào)接收時(shí)刻ts發(fā)射時(shí)刻
ofstream?outfile(“各個(gè)歷元坐標(biāo).txt“ios::out);
ofstream?outfile1(“衛(wèi)星坐標(biāo).txt“ios::out);
cout< sta_polar?sp;//(xyz)坐標(biāo)借用sta_polar結(jié)構(gòu)的
vector?sps;
Matrix?deltx(41);
deltx(30)=0;//衛(wèi)星鐘差
double?sumx=0sumy=0sumz=0exeyez;
for(epc=0;epc {???????Matrix?P(v[epc].num_satv[epc].num_sat);//權(quán)
????????Matrix?dT(v[epc].num_sat1);//衛(wèi)星種差
????????Matrix?x0(41)x1(41)Xx(41);//迭代要用的
????????x1(00)=0;x1(10)=0;x1(20)=0;x1(30)=0;//初始化為地心坐標(biāo)????????
tr=v[epc].gps_sat.num_sec;//第epc歷元的觀測時(shí)刻的秒
sps.clear();//清空容器,不然會(huì)一直存上一歷元的衛(wèi)星坐標(biāo)
double?dt0=0dt1=0;
//sumx=0;sumy=0;sumz=0;
??do
??{
??????????dt0=dt1;
??tr+=dt0;//接收機(jī)種差改正
???
???for(j=0;j ???{????????????????????????????//[epc].num_sat指本歷元的衛(wèi)星個(gè)數(shù)????????????//?
?double?t0=tr-0.075;//初始化
?double?tkmin;
?????for(int?k=0;k ?{
?????if(vn[k].PRN==v[epc].array_sat[j].sat_num)??????????????????????//
?{?tk=fabs(t0-vn[k].TOE.num_sec);min=tk;posk=k;? ??
???????????break;????????????????????????????????????????????????????//
?}
?}
?????for(k=0;k ?{
????if(vn[k].PRN==v[epc].array_sat[j].sat_num)
{
???tk=fabs(t0-vn[k].TOE.num_sec); ?????????????????????????????//??
????????if(tk {
???min=tk;posk=k;
}//獲得間隔最小的衛(wèi)星的位置???
?屬性????????????大小?????日期????時(shí)間???名稱
-----------?---------??----------?-----??----
?????文件??????27220??2002-05-26?15:45??單點(diǎn)定位程序\matrix.h
?????文件???????4631??2007-10-28?18:07??單點(diǎn)定位程序\readfiles.dsp
?????文件???????2552??2007-11-22?19:37??單點(diǎn)定位程序\sat_pos.cpp
?????文件?????140288??2007-12-06?18:47??單點(diǎn)定位程序\readfiles.ncb
?????文件???????2374??2007-12-06?18:47??單點(diǎn)定位程序\readfiles.plg
?????文件????????183??2007-10-28?21:18??單點(diǎn)定位程序\readNfile.h
?????文件???????5390??2007-10-30?21:22??單點(diǎn)定位程序\myStruct.h
?????文件???????8404??2007-11-16?20:11??單點(diǎn)定位程序\test.02n.bak
?????文件???????8397??2007-11-16?20:12??單點(diǎn)定位程序\test.02n
?????文件????????543??2007-11-22?19:11??單點(diǎn)定位程序\readfiles.dsw
?????文件?????134070??2006-11-02?22:28??單點(diǎn)定位程序\test.02o.bak
?????文件?????134068??2007-11-22?19:21??單點(diǎn)定位程序\test.02o
?????文件???????6879??2007-12-06?18:43??單點(diǎn)定位程序\jjj.cpp
?????文件???????4038??2007-12-06?18:44??單點(diǎn)定位程序\readNfile.cpp
?????文件???????5013??2007-12-06?18:44??單點(diǎn)定位程序\readOfile.cpp
?????文件??????54784??2007-12-06?18:47??單點(diǎn)定位程序\readfiles.opt
?????文件?????712816??2007-12-06?18:47??單點(diǎn)定位程序\單點(diǎn)定位程序.exe
?????目錄??????????0??2007-12-06?17:26??單點(diǎn)定位程序\Debug
?????目錄??????????0??2007-12-06?17:26??單點(diǎn)定位程序
-----------?---------??----------?-----??----
??????????????1251650????????????????????19
- 上一篇:51單片機(jī)電子門鈴設(shè)計(jì)
- 下一篇:《匯編語言源代碼大全》
評(píng)論
共有 條評(píng)論