www.pudn.com > GPSComEVC3.0.rar > DisplayView.cpp
// DisplayView.cpp : implementation file
//
#include "stdafx.h"
#include "resource.h"
#include "MainFrm.h"
#include "DisplayView.h"
#include "NameDlg.h"
#include "GpsNavDoc.h"
#ifdef _DEBUG
#define new DEBUG_NEW
#undef THIS_FILE
static char THIS_FILE[] = __FILE__;
#endif
double Rad2Dms(double rad);
double GetBearing(const CWayPoint &wpt1,const CWayPoint &wpt2);
RESULT GetResult(const CString str);
double GetDist(const CWayPoint &wpt1,double x,double y);
double GetDist(const CWayPoint &wpt1,const CWayPoint &wpt2);
FPOINT GetPoint(const CWayPoint &p1,const CWayPoint &p2,const CWayPoint &p3);
/////////////////////////////////////////////////////////////////////////////
// CDisplayView
IMPLEMENT_DYNCREATE(CDisplayView, CFormView)
CDisplayView::CDisplayView()
: CFormView(CDisplayView::IDD)
{
//{{AFX_DATA_INIT(CDisplayView)
// NOTE: the ClassWizard will add member initialization here
//}}AFX_DATA_INIT
}
CDisplayView::~CDisplayView()
{
}
void CDisplayView::DoDataExchange(CDataExchange* pDX)
{
CFormView::DoDataExchange(pDX);
//{{AFX_DATA_MAP(CDisplayView)
// NOTE: the ClassWizard will add DDX and DDV calls here
//}}AFX_DATA_MAP
}
BEGIN_MESSAGE_MAP(CDisplayView, CFormView)
//{{AFX_MSG_MAP(CDisplayView)
ON_BN_CLICKED(IDC_ADDHERE, OnAddhere)
//}}AFX_MSG_MAP
END_MESSAGE_MAP()
/////////////////////////////////////////////////////////////////////////////
// CDisplayView diagnostics
#ifdef _DEBUG
void CDisplayView::AssertValid() const
{
CFormView::AssertValid();
}
void CDisplayView::Dump(CDumpContext& dc) const
{
CFormView::Dump(dc);
}
#endif //_DEBUG
/////////////////////////////////////////////////////////////////////////////
// CDisplayView message handlers
/////////////////////////////////////////////////////////////////////////////
// CDisplayView
void CDisplayView::OnAddhere()
{
// TODO: Add your control notification handler code here
if(((CGpsNavDoc *)GetDocument())->m_Serial==NULL)
{
GetDlgItem(IDC_INFO)->SetWindowText(_T("Please Start Navigation!"));
return;
}
NameDlg dlg;
if(dlg.DoModal()!=IDOK)
{
return;
}
CGpsNavDoc *pDoc=(CGpsNavDoc *)GetDocument();
CString str="";
if(dlg.name=="")
{
str=_T("No Name");
}
else
{
str=dlg.name;
}
int nIndex=pDoc->m_Way.GetForward();
if(nIndex==-1)
{
return;
}
CWayPoint wpt=pDoc->m_Way.GetCurPoint();
wpt.SetPointName(str);
pDoc->m_Way.AddWpt(wpt,nIndex);
pDoc->m_Way.SetAfterward(nIndex);
if(pDoc->m_Way.GetTPoint()>pDoc->m_Way.GetFPoint())
{
pDoc->m_Way.SetForward(nIndex+1);
pDoc->m_Way.SetTPoint(pDoc->m_Way.GetTPoint()+1);
}
else
{
pDoc->m_Way.SetForward(nIndex-1);
pDoc->m_Way.SetTPoint(pDoc->m_Way.GetTPoint()-1);
}
CArray &wps=pDoc->m_Way.GetWpts();
}
void CDisplayView::OnUpdate(CView* pSender, LPARAM lHint, CObject* pHint)
{
// TODO: Add your specialized code here and/or call the base class
CGpsNavDoc *pDoc=(CGpsNavDoc *)GetDocument();
CMainFrame *pMain =(CMainFrame *)AfxGetMainWnd();
CString str="";
CArray &wps=pDoc->m_Way.GetWpts();
if(pDoc->m_Serial==NULL)
{
pDoc->m_Info="";
}
else
{
pDoc->m_Info="";
if( GetDist(pDoc->m_Way.GetCurPoint(),wps[pDoc->m_Way.GetForward()])==0)
{
if(pDoc->m_Way.GetForward()==pDoc->m_Way.GetTPoint())
{
delete pDoc->m_Serial;
pDoc->m_Info="Arrived Destination!";
pMain->m_wndStatusBar.SetPaneText(0,LPCTSTR(pDoc->m_Info),TRUE);
}
int nTemp=pDoc->m_Way.GetForward();
pDoc->m_Way.SetAfterward(nTemp);
pDoc->m_Way.SetForward(2*pDoc->m_Way.GetAfterward()-nTemp);
unsigned short lp[20];
wps[pDoc->m_Way.GetForward()].GetPointName(lp);
pDoc->m_Info="Arrived ";
pDoc->m_Info+=lp;
pDoc->m_Info+=" Point!\r\n";
str.Format(_T("Curent Point:\r\n\tB:%.6lf\r\n\tL:%.6lf\r\n\tH:%.6lf"),Rad2Dms(pDoc->m_Way.GetCurPoint().d.DB),Rad2Dms(pDoc->m_Way.GetCurPoint().d.DL),pDoc->m_Way.GetCurPoint().d.DH);
pDoc->m_Info+=str;
}
else
{
double dis=GetDist(pDoc->m_Way.GetCurPoint(),wps[pDoc->m_Way.GetForward()]);
double totdis=dis;
int i=pDoc->m_Way.GetForward();
if(pDoc->m_Way.GetFPoint()m_Way.GetTPoint())
{
for(;im_Way.GetTPoint();i++)
{
totdis+=GetDist(wps[i],wps[i+1]);
}
}
else
{
for(;i>pDoc->m_Way.GetTPoint();i--)
{
totdis+=GetDist(wps[i],wps[i-1]);
}
}
double Heading=GetBearing(wps[pDoc->m_Way.GetAfterward()],pDoc->m_Way.GetCurPoint());
double Bearing=GetBearing(wps[pDoc->m_Way.GetAfterward()],wps[pDoc->m_Way.GetForward()]);
if( GetDist(pDoc->m_Way.GetCurPoint(),wps[pDoc->m_Way.GetAfterward()])==0)
{
Heading=Bearing;
}
double dmsB=Rad2Dms(Bearing);
double dmsH=Rad2Dms(Heading);
double turn=Rad2Dms(Heading-Bearing);
unsigned short lp[20];
unsigned short lp1[20];
double dx=0,dy=0,dh=0,ds=0;
double elevation=0;
switch(pDoc->nDisFormat)
{
case 0:
pDoc->m_Info=_T("1.Dist/Bearing\r\n");
wps[pDoc->m_Way.GetForward()].GetPointName(lp);
str.Format(_T(">%d %s\r\n"),pDoc->m_Way.GetForward()+1,lp);
pDoc->m_Info+=str;
str.Format(_T("Dist:%.4lfkm\r\n"),dis/1000);
pDoc->m_Info+=str;
if(turn<=180)
{
str.Format(_T("Turn:left%.0lf\r\n"),turn);
pDoc->m_Info+=str;
}
else
{
str.Format(_T("Turn:right%.0lf\r\n"),360.-turn);
pDoc->m_Info+=str;
}
str.Format(_T("Bearing:%.0lf\r\n"),dmsB);
pDoc->m_Info+=str;
str.Format(_T("Heading:%.0lf\r\n"),dmsH);
pDoc->m_Info+=str;
str.Format(_T("Curent Point:\r\n\tB:%.6lf\r\n\tL:%.6lf\r\n\tH:%.6lf"),Rad2Dms(pDoc->m_Way.GetCurPoint().d.DB),Rad2Dms(pDoc->m_Way.GetCurPoint().d.DL),pDoc->m_Way.GetCurPoint().d.DH);
pDoc->m_Info+=str;
break;
case 1:
pDoc->m_Info=_T("2.Track/XTE\r\n");
wps[pDoc->m_Way.GetFPoint()].GetPointName(lp);
wps[pDoc->m_Way.GetTPoint()].GetPointName(lp1);
str.Format(_T("From %s To %s\r\n"),lp,lp1);
pDoc->m_Info+=str;
str.Format(_T("Heading:%.0lf\r\n"),dmsH);
pDoc->m_Info+=str;
str.Format(_T("Dist:%.4lfkm\r\n"),dis/1000);
pDoc->m_Info+=str;
if(turn<=180)
{
FPOINT p=GetPoint(wps[pDoc->m_Way.GetAfterward()],wps[pDoc->m_Way.GetForward()],pDoc->m_Way.GetCurPoint());
str.Format(_T("XTE:+%.4lfKm\r\n"),GetDist(pDoc->m_Way.GetCurPoint(),p.X,p.Y)/1000.);
pDoc->m_Info+=str;
}
else
{
FPOINT p=GetPoint(wps[pDoc->m_Way.GetAfterward()],wps[pDoc->m_Way.GetForward()],pDoc->m_Way.GetCurPoint());
str.Format(_T("XTE:-%.4lfKm\r\n"),GetDist(pDoc->m_Way.GetCurPoint(),p.X,p.Y)/1000.);
pDoc->m_Info+=str;
}
str.Format(_T("Curent Point:\r\n\tB:%.6lf\r\n\tL:%.6lf\r\n\tH:%.6lf"),Rad2Dms(pDoc->m_Way.GetCurPoint().d.DB),Rad2Dms(pDoc->m_Way.GetCurPoint().d.DL),pDoc->m_Way.GetCurPoint().d.DH);
pDoc->m_Info+=str;
break;
case 2:
pDoc->m_Info=_T("3.East/North\r\n");
wps[pDoc->m_Way.GetForward()].GetPointName(lp);
str.Format(_T(">%d %s\r\n"),pDoc->m_Way.GetForward()+1,lp);
pDoc->m_Info+=str;
dx=wps[pDoc->m_Way.GetForward()].c.CX-pDoc->m_Way.GetCurPoint().c.CX;
dy=wps[pDoc->m_Way.GetForward()].c.CY-pDoc->m_Way.GetCurPoint().c.CY;
dh=wps[pDoc->m_Way.GetForward()].c.CH-pDoc->m_Way.GetCurPoint().c.CH;
ds=sqrt(dx*dx+dy*dy);
elevation=atan(dh/ds)/PI*180.0;
str.Format(_T("Elevation:%.0lf\r\n"),elevation);
pDoc->m_Info+=str;
str.Format(_T("Heading:%.0lf\r\n"),dmsH);
pDoc->m_Info+=str;
str.Format(_T("Go E:%.4lfKm\r\n"),dy/1000);
pDoc->m_Info+=str;
str.Format(_T("Go N:%.4lfKm\r\n"),dx/1000);
pDoc->m_Info+=str;
str.Format(_T("Go U:%.4lfKm\r\n"),dh/1000);
pDoc->m_Info+=str;
str.Format(_T("Curent Point:\r\n\tB:%.6lf\r\n\tL:%.6lf\r\n\tH:%.6lf"),Rad2Dms(pDoc->m_Way.GetCurPoint().d.DB),Rad2Dms(pDoc->m_Way.GetCurPoint().d.DL),pDoc->m_Way.GetCurPoint().d.DH);
pDoc->m_Info+=str;
break;
case 3:
pDoc->m_Info=_T("4.Velocity/Time\r\n");
wps[pDoc->m_Way.GetFPoint()].GetPointName(lp);
wps[pDoc->m_Way.GetTPoint()].GetPointName(lp1);
str.Format(_T("From %s To %s\r\n"),lp,lp1);
pDoc->m_Info+=str;
str.Format(_T("Vel:N/A\r\n"));
pDoc->m_Info+=str;
str.Format(_T("TTG:N/A\r\n"));
pDoc->m_Info+=str;
str.Format(_T("ETA:N/A\r\n"));
pDoc->m_Info+=str;
if(turn<=180)
{
str.Format(_T("Turn:left%.0lf\r\n"),turn);
pDoc->m_Info+=str;
}
else
{
str.Format(_T("Turn:right%.0lf\r\n"),360.-turn);
pDoc->m_Info+=str;
}
str.Format(_T("Heading:%.0lf\r\n"),dmsH);
pDoc->m_Info+=str;
str.Format(_T("TotDist:%.4lfkm\r\n"),totdis/1000);
pDoc->m_Info+=str;
str.Format(_T("Curent Point:\r\n\tB:%.6lf\r\n\tL:%.6lf\r\n\tH:%.6lf"),Rad2Dms(pDoc->m_Way.GetCurPoint().d.DB),Rad2Dms(pDoc->m_Way.GetCurPoint().d.DL),pDoc->m_Way.GetCurPoint().d.DH);
pDoc->m_Info+=str;
break;
}
}
}
GetDlgItem(IDC_INFO)->SetWindowText(pDoc->m_Info);
}