bool Multiplexer::SendRouteToGPS(Route *pr, wxString &com_name, bool bsend_waypoints, wxGauge *pProgress)
{
bool ret_bool = false;
DataStream *old_stream = FindStream( com_name );
if( old_stream ) {
SaveStreamProperties( old_stream );
StopAndRemoveStream( old_stream );
}
#ifdef USE_GARMINHOST
#ifdef __WXMSW__
if(com_name.Upper().Matches(_T("*GARMIN*"))) // Garmin USB Mode
{
// if(m_pdevmon)
// m_pdevmon->StopIOThread(true);
int v_init = Garmin_GPS_Init(wxString(_T("usb:")));
if(v_init < 0)
{
wxString msg(_T(" Garmin USB GPS could not be initialized"));
wxLogMessage(msg);
msg.Printf(_T(" Error Code is %d"), v_init);
wxLogMessage(msg);
msg = _T(" LastGarminError is: ");
msg += GetLastGarminError();
wxLogMessage(msg);
ret_bool = false;
}
else
{
wxLogMessage(_T("Garmin USB Initialized"));
wxString msg = _T("USB Unit identifies as: ");
wxString GPS_Unit = Garmin_GPS_GetSaveString();
msg += GPS_Unit;
wxLogMessage(msg);
wxLogMessage(_T("Sending Routes..."));
int ret1 = Garmin_GPS_SendRoute(wxString(_T("usb:")), pr, pProgress);
if(ret1 != 1)
{
wxLogMessage(_T(" Error Sending Routes"));
wxString msg;
msg = _T(" LastGarminError is: ");
msg += GetLastGarminError();
wxLogMessage(msg);
ret_bool = false;
}
else
ret_bool = true;
}
// if(m_pdevmon)
// m_pdevmon->RestartIOThread();
goto ret_point_1;
}
#endif
if(g_bGarminHostUpload)
{
int ret_val;
if ( pProgress )
{
pProgress->SetValue ( 20 );
pProgress->Refresh();
pProgress->Update();
}
wxString short_com = com_name.Mid(7);
// Initialize the Garmin receiver, build required Jeeps internal data structures
int v_init = Garmin_GPS_Init(short_com);
if(v_init < 0)
{
wxString msg(_T("Garmin GPS could not be initialized on port: "));
msg +=short_com;
wxString err;
err.Printf(_T(" Error Code is %d"), v_init);
msg += err;
msg += _T("\n LastGarminError is: ");
msg += GetLastGarminError();
wxLogMessage(msg);
ret_bool = false;
goto ret_point;
}
else
{
wxString msg(_T("Sent Route to Garmin GPS on port: "));
msg +=short_com;
msg += _T("\n Unit identifies as: ");
wxString GPS_Unit = Garmin_GPS_GetSaveString();
msg += GPS_Unit;
wxLogMessage(msg);
}
if ( pProgress )
{
pProgress->SetValue ( 40 );
pProgress->Refresh();
pProgress->Update();
}
ret_val = Garmin_GPS_SendRoute(short_com, pr, pProgress);
if(ret_val != 1)
{
wxString msg(_T("Error Sending Route to Garmin GPS on port: "));
msg +=short_com;
wxString err;
err.Printf(_T(" Error Code is %d"), ret_val);
msg += _T("\n LastGarminError is: ");
msg += GetLastGarminError();
msg += err;
wxLogMessage(msg);
ret_bool = false;
goto ret_point;
}
else
ret_bool = true;
ret_point:
if ( pProgress )
{
pProgress->SetValue ( 100 );
pProgress->Refresh();
pProgress->Update();
}
wxMilliSleep ( 500 );
goto ret_point_1;
}
else
#endif //USE_GARMINHOST
{
{ // Standard NMEA mode
// If the port was temporarily closed, reopen as I/O type
// Otherwise, open another port using default properties
wxString baud;
if( old_stream ) {
baud = baud_rate_save;
}
else {
baud = _T("4800");
}
DataStream *dstr = new DataStream( this,
com_name,
baud,
DS_TYPE_INPUT_OUTPUT,
0 );
SENTENCE snt;
NMEA0183 oNMEA0183;
oNMEA0183.TalkerID = _T ( "EC" );
int nProg = pr->pRoutePointList->GetCount() + 1;
if ( pProgress )
pProgress->SetRange ( 100 );
int progress_stall = 500;
if(pr->pRoutePointList->GetCount() > 10)
progress_stall = 500;
// Send out the waypoints, in order
if ( bsend_waypoints )
{
wxRoutePointListNode *node = pr->pRoutePointList->GetFirst();
int ip = 1;
while ( node )
{
RoutePoint *prp = node->GetData();
if(g_GPS_Ident == _T("Generic"))
{
if ( prp->m_lat < 0. )
oNMEA0183.Wpl.Position.Latitude.Set ( -prp->m_lat, _T ( "S" ) );
else
oNMEA0183.Wpl.Position.Latitude.Set ( prp->m_lat, _T ( "N" ) );
if ( prp->m_lon < 0. )
oNMEA0183.Wpl.Position.Longitude.Set ( -prp->m_lon, _T ( "W" ) );
else
oNMEA0183.Wpl.Position.Longitude.Set ( prp->m_lon, _T ( "E" ) );
oNMEA0183.Wpl.To = prp->GetName().Truncate ( 6 );
oNMEA0183.Wpl.Write ( snt );
}
else if(g_GPS_Ident == _T("FurunoGP3X"))
{
oNMEA0183.TalkerID = _T ( "PFEC," );
if ( prp->m_lat < 0. )
oNMEA0183.GPwpl.Position.Latitude.Set ( -prp->m_lat, _T ( "S" ) );
else
oNMEA0183.GPwpl.Position.Latitude.Set ( prp->m_lat, _T ( "N" ) );
if ( prp->m_lon < 0. )
oNMEA0183.GPwpl.Position.Longitude.Set ( -prp->m_lon, _T ( "W" ) );
else
oNMEA0183.GPwpl.Position.Longitude.Set ( prp->m_lon, _T ( "E" ) );
oNMEA0183.GPwpl.To = prp->GetName().Truncate ( 8 );
oNMEA0183.GPwpl.Write ( snt );
}
if( dstr->SendSentence( snt.Sentence ) )
LogOutputMessage( snt.Sentence, dstr->GetPort(), false );
wxString msg(_T("-->GPS Port:"));
msg += com_name;
msg += _T(" Sentence: ");
msg += snt.Sentence;
msg.Trim();
wxLogMessage(msg);
if ( pProgress )
{
pProgress->SetValue ( ( ip * 100 ) / nProg );
pProgress->Refresh();
pProgress->Update();
}
wxMilliSleep ( progress_stall );
node = node->GetNext();
ip++;
}
}
// Create the NMEA Rte sentence
oNMEA0183.Rte.Empty();
oNMEA0183.Rte.TypeOfRoute = CompleteRoute;
if ( pr->m_RouteNameString.IsEmpty() )
oNMEA0183.Rte.RouteName = _T ( "1" );
else
oNMEA0183.Rte.RouteName = pr->m_RouteNameString;
if(g_GPS_Ident == _T("FurunoGP3X"))
{
oNMEA0183.Rte.RouteName = _T ( "1" );
oNMEA0183.TalkerID = _T ( "GP" );
}
oNMEA0183.Rte.total_number_of_messages = 1;
oNMEA0183.Rte.message_number = 1;
// add the waypoints
wxRoutePointListNode *node = pr->pRoutePointList->GetFirst();
while ( node )
{
RoutePoint *prp = node->GetData();
wxString name = prp->GetName().Truncate ( 6 );
if(g_GPS_Ident == _T("FurunoGP3X"))
{
name = prp->GetName().Truncate ( 7 );
name.Prepend(_T(" "));
}
oNMEA0183.Rte.AddWaypoint ( name );
node = node->GetNext();
}
oNMEA0183.Rte.Write ( snt );
unsigned int max_length = 70;
if(snt.Sentence.Len() > max_length)
{
// Make a route with one waypoint to get tare load.
NMEA0183 tNMEA0183;
SENTENCE tsnt;
tNMEA0183.TalkerID = _T ( "EC" );
tNMEA0183.Rte.Empty();
tNMEA0183.Rte.TypeOfRoute = CompleteRoute;
if(g_GPS_Ident != _T("FurunoGP3X"))
{
if ( pr->m_RouteNameString.IsEmpty() )
tNMEA0183.Rte.RouteName = _T ( "1" );
else
tNMEA0183.Rte.RouteName = pr->m_RouteNameString;
tNMEA0183.Rte.AddWaypoint ( _T("123456") );
}
else
{
if (( pr->m_RouteNameString.IsNumber() ) &&
( pr->m_RouteNameString.Len() <= 2 ) ) {
if( pr->m_RouteNameString.Len() == 2) {
tNMEA0183.Rte.RouteName = pr->m_RouteNameString;
}
else {
tNMEA0183.Rte.RouteName = _T("0");
tNMEA0183.Rte.RouteName += pr->m_RouteNameString;
}
}
else
{
tNMEA0183.Rte.RouteName = _T ( "01" );
}
tNMEA0183.Rte.AddWaypoint ( _T(" 1234567") );
}
tNMEA0183.Rte.Write ( tsnt );
unsigned int tare_length = tsnt.Sentence.Len();
wxArrayString sentence_array;
// Trial balloon: add the waypoints, with length checking
int n_total = 1;
bool bnew_sentence = true;
int sent_len=0;
wxRoutePointListNode *node = pr->pRoutePointList->GetFirst();
while ( node )
{
RoutePoint *prp = node->GetData();
unsigned int name_len = prp->GetName().Truncate ( 6 ).Len();
if(g_GPS_Ident == _T("FurunoGP3X"))
name_len = 1 + prp->GetName().Truncate ( 7 ).Len();
if(bnew_sentence)
{
sent_len = tare_length;
sent_len += name_len;
bnew_sentence = false;
node = node->GetNext();
}
else
{
if(sent_len + name_len > max_length)
{
n_total ++;
bnew_sentence = true;
}
else
{
sent_len += name_len;
node = node->GetNext();
}
}
}
// Now we have the sentence count, so make the real sentences using the same counting logic
int final_total = n_total;
int n_run = 1;
bnew_sentence = true;
node = pr->pRoutePointList->GetFirst();
while ( node )
{
RoutePoint *prp = node->GetData();
wxString name = prp->GetName().Truncate ( 6 );
if(g_GPS_Ident == _T("FurunoGP3X"))
{
name = prp->GetName().Truncate ( 7 );
name.Prepend(_T(" "));
}
unsigned int name_len = name.Len();
if(bnew_sentence)
{
sent_len = tare_length;
sent_len += name_len;
bnew_sentence = false;
oNMEA0183.Rte.Empty();
oNMEA0183.Rte.TypeOfRoute = CompleteRoute;
if(g_GPS_Ident != _T("FurunoGP3X"))
{
if ( pr->m_RouteNameString.IsEmpty() )
oNMEA0183.Rte.RouteName = _T ( "1" );
else
oNMEA0183.Rte.RouteName = pr->m_RouteNameString;
}
else {
if (( pr->m_RouteNameString.IsNumber() ) &&
( pr->m_RouteNameString.Len() <= 2 ) ) {
if( pr->m_RouteNameString.Len() == 2) {
oNMEA0183.Rte.RouteName = pr->m_RouteNameString;
}
else {
oNMEA0183.Rte.RouteName = _T("0");
oNMEA0183.Rte.RouteName += pr->m_RouteNameString;
}
}
else {
oNMEA0183.Rte.RouteName = _T ( "01" );
}
}
oNMEA0183.Rte.total_number_of_messages = final_total;
oNMEA0183.Rte.message_number = n_run;
snt.Sentence.Clear();
oNMEA0183.Rte.AddWaypoint ( name );
node = node->GetNext();
}
else
{
if(sent_len + name_len > max_length)
{
n_run ++;
bnew_sentence = true;
oNMEA0183.Rte.Write ( snt );
// printf("%s", snt.Sentence.mb_str());
sentence_array.Add(snt.Sentence);
}
else
{
sent_len += name_len;
oNMEA0183.Rte.AddWaypoint ( name );
node = node->GetNext();
}
}
}
oNMEA0183.Rte.Write ( snt ); //last one...
if(snt.Sentence.Len() > tare_length)
sentence_array.Add(snt.Sentence);
for(unsigned int ii=0 ; ii < sentence_array.GetCount(); ii++)
{
if(dstr->SendSentence( sentence_array.Item(ii) ) )
LogOutputMessage( sentence_array.Item(ii), dstr->GetPort(), false );
wxString msg(_T("-->GPS Port:"));
msg += com_name;
msg += _T(" Sentence: ");
msg += sentence_array.Item(ii);
msg.Trim();
wxLogMessage(msg);
wxMilliSleep ( 500 );
}
}
else
{
if( dstr->SendSentence( snt.Sentence ) )
LogOutputMessage( snt.Sentence, dstr->GetPort(), false );
wxString msg(_T("-->GPS Port:"));
msg += com_name;
msg += _T(" Sentence: ");
msg += snt.Sentence;
msg.Trim();
wxLogMessage(msg);
}
if(g_GPS_Ident == _T("FurunoGP3X"))
{
wxString term;
term.Printf(_T("$PFEC,GPxfr,CTL,E%c%c"), 0x0d, 0x0a);
if( dstr->SendSentence( term ) )
LogOutputMessage( term, dstr->GetPort(), false );
wxString msg(_T("-->GPS Port:"));
msg += com_name;
msg += _T(" Sentence: ");
msg += term;
msg.Trim();
wxLogMessage(msg);
}
if ( pProgress )
{
pProgress->SetValue ( 100 );
pProgress->Refresh();
pProgress->Update();
}
wxMilliSleep ( 500 );
ret_bool = true;
// All finished with the temp port
dstr->Close();
}
}
ret_point_1:
if( old_stream )
CreateAndRestoreSavedStreamProperties();
return ret_bool;
}
bool Multiplexer::SendWaypointToGPS(RoutePoint *prp, wxString &com_name, wxGauge *pProgress)
{
bool ret_bool = false;
DataStream *old_stream = FindStream( com_name );
if( old_stream ) {
SaveStreamProperties( old_stream );
StopAndRemoveStream( old_stream );
}
#ifdef USE_GARMINHOST
#ifdef __WXMSW__
if(com_name.Upper().Matches(_T("*GARMIN*"))) // Garmin USB Mode
{
// if(m_pdevmon)
// m_pdevmon->StopIOThread(true);
int v_init = Garmin_GPS_Init(wxString(_T("usb:")));
if(v_init < 0)
{
wxString msg(_T(" Garmin USB GPS could not be initialized"));
wxLogMessage(msg);
msg.Printf(_T(" Error Code is %d"), v_init);
wxLogMessage(msg);
msg = _T(" LastGarminError is: ");
msg += GetLastGarminError();
wxLogMessage(msg);
ret_bool = false;
}
else
{
wxLogMessage(_T("Garmin USB Initialized"));
wxString msg = _T("USB Unit identifies as: ");
wxString GPS_Unit = Garmin_GPS_GetSaveString();
msg += GPS_Unit;
wxLogMessage(msg);
wxLogMessage(_T("Sending Waypoint..."));
// Create a RoutePointList with one item
RoutePointList rplist;
rplist.Append(prp);
int ret1 = Garmin_GPS_SendWaypoints(wxString(_T("usb:")), &rplist);
if(ret1 != 1)
{
wxLogMessage(_T(" Error Sending Waypoint to Garmin USB"));
wxString msg;
msg = _T(" LastGarminError is: ");
msg += GetLastGarminError();
wxLogMessage(msg);
ret_bool = false;
}
else
ret_bool = true;
}
// if(m_pdevmon)
// m_pdevmon->RestartIOThread();
return ret_bool;
}
#endif
// Are we using Garmin Host mode for uploads?
if(g_bGarminHostUpload)
{
RoutePointList rplist;
int ret_val;
wxString short_com = com_name.Mid(7);
// Initialize the Garmin receiver, build required Jeeps internal data structures
int v_init = Garmin_GPS_Init(short_com);
if(v_init < 0)
{
wxString msg(_T("Garmin GPS could not be initialized on port: "));
msg +=com_name;
wxString err;
err.Printf(_T(" Error Code is %d"), v_init);
msg += err;
msg += _T("\n LastGarminError is: ");
msg += GetLastGarminError();
wxLogMessage(msg);
ret_bool = false;
goto ret_point;
}
else
{
wxString msg(_T("Sent waypoint(s) to Garmin GPS on port: "));
msg +=com_name;
msg += _T("\n Unit identifies as: ");
wxString GPS_Unit = Garmin_GPS_GetSaveString();
msg += GPS_Unit;
wxLogMessage(msg);
}
// Create a RoutePointList with one item
rplist.Append(prp);
ret_val = Garmin_GPS_SendWaypoints(short_com, &rplist);
if(ret_val != 1)
{
wxString msg(_T("Error Sending Waypoint(s) to Garmin GPS on port: "));
msg +=com_name;
wxString err;
err.Printf(_T(" Error Code is %d"), ret_val);
msg += err;
msg += _T("\n LastGarminError is: ");
msg += GetLastGarminError();
wxLogMessage(msg);
ret_bool = false;
goto ret_point;
}
else
ret_bool = true;
goto ret_point;
}
else
#endif //USE_GARMINHOST
{ // Standard NMEA mode
// If the port was temporarily closed, reopen as I/O type
// Otherwise, open another port using default properties
wxString baud;
if( old_stream ) {
baud = baud_rate_save;
}
else {
baud = _T("4800");
}
DataStream *dstr = new DataStream( this,
com_name,
baud,
DS_TYPE_INPUT_OUTPUT,
0 );
SENTENCE snt;
NMEA0183 oNMEA0183;
oNMEA0183.TalkerID = _T ( "EC" );
if ( pProgress )
pProgress->SetRange ( 100 );
if(g_GPS_Ident == _T("Generic"))
{
if ( prp->m_lat < 0. )
oNMEA0183.Wpl.Position.Latitude.Set ( -prp->m_lat, _T ( "S" ) );
else
oNMEA0183.Wpl.Position.Latitude.Set ( prp->m_lat, _T ( "N" ) );
if ( prp->m_lon < 0. )
oNMEA0183.Wpl.Position.Longitude.Set ( -prp->m_lon, _T ( "W" ) );
else
oNMEA0183.Wpl.Position.Longitude.Set ( prp->m_lon, _T ( "E" ) );
oNMEA0183.Wpl.To = prp->GetName().Truncate ( 6 );
oNMEA0183.Wpl.Write ( snt );
}
else if(g_GPS_Ident == _T("FurunoGP3X"))
{
oNMEA0183.TalkerID = _T ( "PFEC," );
if ( prp->m_lat < 0. )
oNMEA0183.GPwpl.Position.Latitude.Set ( -prp->m_lat, _T ( "S" ) );
else
oNMEA0183.GPwpl.Position.Latitude.Set ( prp->m_lat, _T ( "N" ) );
if ( prp->m_lon < 0. )
oNMEA0183.GPwpl.Position.Longitude.Set ( -prp->m_lon, _T ( "W" ) );
else
oNMEA0183.GPwpl.Position.Longitude.Set ( prp->m_lon, _T ( "E" ) );
oNMEA0183.GPwpl.To = prp->GetName().Truncate ( 8 );
oNMEA0183.GPwpl.Write ( snt );
}
if( dstr->SendSentence( snt.Sentence ) )
LogOutputMessage( snt.Sentence, dstr->GetPort(), false );
wxString msg(_T("-->GPS Port:"));
msg += com_name;
msg += _T(" Sentence: ");
msg += snt.Sentence;
msg.Trim();
wxLogMessage(msg);
if(g_GPS_Ident == _T("FurunoGP3X"))
{
wxString term;
term.Printf(_T("$PFEC,GPxfr,CTL,E%c%c"), 0x0d, 0x0a);
if( dstr->SendSentence( term ) )
LogOutputMessage( term, dstr->GetPort(), false );
wxString msg(_T("-->GPS Port:"));
msg += com_name;
msg += _T(" Sentence: ");
msg += term;
msg.Trim();
wxLogMessage(msg);
}
if ( pProgress )
{
pProgress->SetValue ( 100 );
pProgress->Refresh();
pProgress->Update();
}
wxMilliSleep ( 500 );
// All finished with the temp port
dstr->Close();
ret_bool = true;
}
ret_point:
if( old_stream )
CreateAndRestoreSavedStreamProperties();
return ret_bool;
}
int Multiplexer::SendRouteToGPS(Route *pr, const wxString &com_name, bool bsend_waypoints, wxGauge *pProgress)
{
int ret_val = 0;
DataStream *old_stream = FindStream( com_name );
if( old_stream ) {
SaveStreamProperties( old_stream );
StopAndRemoveStream( old_stream );
}
#ifdef USE_GARMINHOST
#ifdef __WXMSW__
if(com_name.Upper().Matches(_T("*GARMIN*"))) // Garmin USB Mode
{
// if(m_pdevmon)
// m_pdevmon->StopIOThread(true);
int v_init = Garmin_GPS_Init(wxString(_T("usb:")));
if(v_init < 0)
{
wxString msg(_T(" Garmin USB GPS could not be initialized"));
wxLogMessage(msg);
msg.Printf(_T(" Error Code is %d"), v_init);
wxLogMessage(msg);
msg = _T(" LastGarminError is: ");
msg += GetLastGarminError();
wxLogMessage(msg);
ret_val = ERR_GARMIN_INITIALIZE;
}
else
{
wxLogMessage(_T("Garmin USB Initialized"));
wxString msg = _T("USB Unit identifies as: ");
wxString GPS_Unit = Garmin_GPS_GetSaveString();
msg += GPS_Unit;
wxLogMessage(msg);
wxLogMessage(_T("Sending Routes..."));
int ret1 = Garmin_GPS_SendRoute(wxString(_T("usb:")), pr, pProgress);
if(ret1 != 1)
{
wxLogMessage(_T(" Error Sending Routes"));
wxString msg;
msg = _T(" LastGarminError is: ");
msg += GetLastGarminError();
wxLogMessage(msg);
ret_val = ERR_GARMIN_GENERAL;
}
else
ret_val = 0;
}
// if(m_pdevmon)
// m_pdevmon->RestartIOThread();
goto ret_point_1;
}
#endif
if(g_bGarminHostUpload)
{
int lret_val;
if ( pProgress )
{
pProgress->SetValue ( 20 );
pProgress->Refresh();
pProgress->Update();
}
wxString short_com = com_name.Mid(7);
// Initialize the Garmin receiver, build required Jeeps internal data structures
int v_init = Garmin_GPS_Init(short_com);
if(v_init < 0)
{
wxString msg(_T("Garmin GPS could not be initialized on port: "));
msg +=short_com;
wxString err;
err.Printf(_T(" Error Code is %d"), v_init);
msg += err;
msg += _T("\n LastGarminError is: ");
msg += GetLastGarminError();
wxLogMessage(msg);
ret_val = ERR_GARMIN_INITIALIZE;
goto ret_point;
}
else
{
wxString msg(_T("Sent Route to Garmin GPS on port: "));
msg +=short_com;
msg += _T("\n Unit identifies as: ");
wxString GPS_Unit = Garmin_GPS_GetSaveString();
msg += GPS_Unit;
wxLogMessage(msg);
}
if ( pProgress )
{
pProgress->SetValue ( 40 );
pProgress->Refresh();
pProgress->Update();
}
lret_val = Garmin_GPS_SendRoute(short_com, pr, pProgress);
if(lret_val != 1)
{
wxString msg(_T("Error Sending Route to Garmin GPS on port: "));
msg +=short_com;
wxString err;
err.Printf(_T(" Error Code is %d"), ret_val);
msg += _T("\n LastGarminError is: ");
msg += GetLastGarminError();
msg += err;
wxLogMessage(msg);
ret_val = ERR_GARMIN_GENERAL;
goto ret_point;
}
else
ret_val = 0;
ret_point:
if ( pProgress )
{
pProgress->SetValue ( 100 );
pProgress->Refresh();
pProgress->Update();
}
wxMilliSleep ( 500 );
goto ret_point_1;
}
else
#endif //USE_GARMINHOST
{
{ // Standard NMEA mode
// If the port was temporarily closed, reopen as I/O type
// Otherwise, open another port using default properties
wxString baud;
if( old_stream ) {
baud = baud_rate_save;
}
else {
baud = _T("4800");
}
DataStream *dstr = new DataStream( this,
SERIAL,
com_name,
baud,
DS_TYPE_INPUT_OUTPUT,
0 );
// Wait up to 5 seconds for Datastream secondary thread to come up
int timeout = 0;
while( !dstr-> IsSecThreadActive() && (timeout < 50)) {
wxMilliSleep(100);
timeout++;
}
if( !dstr-> IsSecThreadActive() ){
wxString msg(_T("-->GPS Port:"));
msg += com_name;
msg += _T(" ...Could not be opened for writing");
wxLogMessage(msg);
dstr->Close();
goto ret_point_1;
}
SENTENCE snt;
NMEA0183 oNMEA0183;
oNMEA0183.TalkerID = _T ( "EC" );
int nProg = pr->pRoutePointList->GetCount() + 1;
if ( pProgress )
pProgress->SetRange ( 100 );
int progress_stall = 500;
if(pr->pRoutePointList->GetCount() > 10)
progress_stall = 200;
if(!pProgress)
progress_stall = 200; // 80 chars at 4800 baud is ~160 msec
// Send out the waypoints, in order
if ( bsend_waypoints )
{
wxRoutePointListNode *node = pr->pRoutePointList->GetFirst();
int ip = 1;
while ( node )
{
RoutePoint *prp = node->GetData();
if(g_GPS_Ident == _T("Generic"))
{
if ( prp->m_lat < 0. )
oNMEA0183.Wpl.Position.Latitude.Set ( -prp->m_lat, _T ( "S" ) );
else
oNMEA0183.Wpl.Position.Latitude.Set ( prp->m_lat, _T ( "N" ) );
if ( prp->m_lon < 0. )
oNMEA0183.Wpl.Position.Longitude.Set ( -prp->m_lon, _T ( "W" ) );
else
oNMEA0183.Wpl.Position.Longitude.Set ( prp->m_lon, _T ( "E" ) );
oNMEA0183.Wpl.To = prp->GetName().Truncate ( 6 );
oNMEA0183.Wpl.Write ( snt );
}
else if(g_GPS_Ident == _T("FurunoGP3X"))
{
oNMEA0183.TalkerID = _T ( "PFEC," );
if ( prp->m_lat < 0. )
oNMEA0183.GPwpl.Position.Latitude.Set ( -prp->m_lat, _T ( "S" ) );
else
oNMEA0183.GPwpl.Position.Latitude.Set ( prp->m_lat, _T ( "N" ) );
if ( prp->m_lon < 0. )
oNMEA0183.GPwpl.Position.Longitude.Set ( -prp->m_lon, _T ( "W" ) );
else
oNMEA0183.GPwpl.Position.Longitude.Set ( prp->m_lon, _T ( "E" ) );
wxString name = prp->GetName();
name += _T("000000");
name.Truncate( 6 );
oNMEA0183.GPwpl.To = name;
oNMEA0183.GPwpl.Write ( snt );
}
wxString payload = snt.Sentence;
// for some gps, like some garmin models, they assume the first waypoint
// in the route is the boat location, therefore it is dropped.
// These gps also can only accept a maximum of up to 20 waypoints at a time before
// a delay is needed and a new string of waypoints may be sent.
// To ensure all waypoints will arrive, we can simply send each one twice.
// This ensures that the gps will get the waypoint and also allows us to send as many as we like
payload += _T("\r\n") + payload;
if( dstr->SendSentence( payload ) )
LogOutputMessage( snt.Sentence, dstr->GetPort(), false );
wxString msg(_T("-->GPS Port:"));
msg += com_name;
msg += _T(" Sentence: ");
msg += snt.Sentence;
msg.Trim();
wxLogMessage(msg);
if ( pProgress )
{
pProgress->SetValue ( ( ip * 100 ) / nProg );
pProgress->Refresh();
pProgress->Update();
}
wxMilliSleep ( progress_stall );
node = node->GetNext();
ip++;
}
}
// Create the NMEA Rte sentence
// Try to create a single sentence, and then check the length to see if too long
unsigned int max_length = 76;
unsigned int max_wp = 2; // seems to be required for garmin...
// Furuno GPS can only accept 5 (five) waypoint linkage sentences....
// So, we need to compact a few more points into each link sentence.
if(g_GPS_Ident == _T("FurunoGP3X")){
max_wp = 6;
}
oNMEA0183.Rte.Empty();
oNMEA0183.Rte.TypeOfRoute = CompleteRoute;
if ( pr->m_RouteNameString.IsEmpty() )
oNMEA0183.Rte.RouteName = _T ( "1" );
else
oNMEA0183.Rte.RouteName = pr->m_RouteNameString;
if(g_GPS_Ident == _T("FurunoGP3X"))
{
oNMEA0183.Rte.RouteName = _T ( "01" );
oNMEA0183.TalkerID = _T ( "GP" );
oNMEA0183.Rte.m_complete_char = 'C'; // override the default "c"
oNMEA0183.Rte.m_skip_checksum = 1; // no checksum needed
}
oNMEA0183.Rte.total_number_of_messages = 1;
oNMEA0183.Rte.message_number = 1;
// add the waypoints
wxRoutePointListNode *node = pr->pRoutePointList->GetFirst();
while ( node )
{
RoutePoint *prp = node->GetData();
wxString name = prp->GetName().Truncate ( 6 );
if(g_GPS_Ident == _T("FurunoGP3X"))
{
name = prp->GetName();
name += _T("000000");
name.Truncate( 6 );
name .Prepend( _T(" ")); // What Furuno calls "Skip Code", space means use the WP
}
oNMEA0183.Rte.AddWaypoint ( name );
node = node->GetNext();
}
oNMEA0183.Rte.Write ( snt );
if( (snt.Sentence.Len() > max_length)
|| (pr->pRoutePointList->GetCount() > max_wp) ) // Do we need split sentences?
{
// Make a route with zero waypoints to get tare load.
NMEA0183 tNMEA0183;
SENTENCE tsnt;
tNMEA0183.TalkerID = _T ( "EC" );
tNMEA0183.Rte.Empty();
tNMEA0183.Rte.TypeOfRoute = CompleteRoute;
if(g_GPS_Ident != _T("FurunoGP3X"))
{
if ( pr->m_RouteNameString.IsEmpty() )
tNMEA0183.Rte.RouteName = _T ( "1" );
else
tNMEA0183.Rte.RouteName = pr->m_RouteNameString;
}
else
{
tNMEA0183.Rte.RouteName = _T ( "01" );
}
tNMEA0183.Rte.Write ( tsnt );
unsigned int tare_length = tsnt.Sentence.Len();
wxArrayString sentence_array;
// Trial balloon: add the waypoints, with length checking
int n_total = 1;
bool bnew_sentence = true;
int sent_len=0;
unsigned int wp_count = 0;
wxRoutePointListNode *node = pr->pRoutePointList->GetFirst();
while ( node )
{
RoutePoint *prp = node->GetData();
unsigned int name_len = prp->GetName().Truncate ( 6 ).Len();
if(g_GPS_Ident == _T("FurunoGP3X"))
name_len = 7; // six chars, with leading space for "Skip Code"
if(bnew_sentence)
{
sent_len = tare_length;
sent_len += name_len + 1; // with comma
bnew_sentence = false;
node = node->GetNext();
wp_count = 1;
}
else
{
if( (sent_len + name_len > max_length) || (wp_count >= max_wp) )
{
n_total ++;
bnew_sentence = true;
}
else
{
sent_len += name_len + 1; // with comma
wp_count++;
node = node->GetNext();
}
}
}
// Now we have the sentence count, so make the real sentences using the same counting logic
int final_total = n_total;
int n_run = 1;
bnew_sentence = true;
node = pr->pRoutePointList->GetFirst();
while ( node )
{
RoutePoint *prp = node->GetData();
wxString name = prp->GetName().Truncate ( 6 );
if(g_GPS_Ident == _T("FurunoGP3X"))
{
name = prp->GetName();
name += _T("000000");
name.Truncate( 6 );
name .Prepend( _T(" ")); // What Furuno calls "Skip Code", space means use the WP
}
unsigned int name_len = name.Len();
if(bnew_sentence)
{
sent_len = tare_length;
sent_len += name_len + 1; // comma
bnew_sentence = false;
oNMEA0183.Rte.Empty();
oNMEA0183.Rte.TypeOfRoute = CompleteRoute;
if(g_GPS_Ident != _T("FurunoGP3X"))
{
if ( pr->m_RouteNameString.IsEmpty() )
oNMEA0183.Rte.RouteName = _T ( "1" );
else
oNMEA0183.Rte.RouteName = pr->m_RouteNameString;
}
else {
oNMEA0183.Rte.RouteName = _T ( "01" );
}
oNMEA0183.Rte.total_number_of_messages = final_total;
oNMEA0183.Rte.message_number = n_run;
snt.Sentence.Clear();
wp_count = 1;
oNMEA0183.Rte.AddWaypoint ( name );
node = node->GetNext();
}
else
{
if( (sent_len + name_len > max_length) || (wp_count >= max_wp) )
{
n_run ++;
bnew_sentence = true;
oNMEA0183.Rte.Write ( snt );
sentence_array.Add(snt.Sentence);
}
else
{
sent_len += name_len + 1; // comma
oNMEA0183.Rte.AddWaypoint ( name );
wp_count ++;
node = node->GetNext();
}
}
}
oNMEA0183.Rte.Write ( snt ); //last one...
if(snt.Sentence.Len() > tare_length)
sentence_array.Add(snt.Sentence);
for(unsigned int ii=0 ; ii < sentence_array.GetCount(); ii++)
{
wxString sentence = sentence_array.Item(ii);
if(dstr->SendSentence( sentence ) )
LogOutputMessage( sentence, dstr->GetPort(), false );
wxString msg(_T("-->GPS Port:"));
msg += com_name;
msg += _T(" Sentence: ");
msg += sentence;
msg.Trim();
wxLogMessage(msg);
wxMilliSleep ( progress_stall );
}
}
else
{
if( dstr->SendSentence( snt.Sentence ) )
LogOutputMessage( snt.Sentence, dstr->GetPort(), false );
wxString msg(_T("-->GPS Port:"));
msg += com_name;
msg += _T(" Sentence: ");
msg += snt.Sentence;
msg.Trim();
wxLogMessage(msg);
}
if(g_GPS_Ident == _T("FurunoGP3X"))
{
wxString term;
term.Printf(_T("$PFEC,GPxfr,CTL,E%c%c"), 0x0d, 0x0a);
if( dstr->SendSentence( term ) )
LogOutputMessage( term, dstr->GetPort(), false );
wxString msg(_T("-->GPS Port:"));
msg += com_name;
msg += _T(" Sentence: ");
msg += term;
msg.Trim();
wxLogMessage(msg);
}
if ( pProgress )
{
pProgress->SetValue ( 100 );
pProgress->Refresh();
pProgress->Update();
}
wxMilliSleep ( progress_stall );
ret_val = 0;
// All finished with the temp port
dstr->Close();
}
}
ret_point_1:
if( old_stream )
CreateAndRestoreSavedStreamProperties();
return ret_val;
}