// EPS: Elgaard Positioning System: GPS navigation software.
// Copyright (C) 1997, 1999  Niels Elgaard Larsen

//     This program is free software; you can redistribute it and/or modify
//     it under the terms of the GNU General Public License as published by
//     the Free Software Foundation; either version 2 of the License, or
//     (at your option) any later version.

//     This program is distributed in the hope that it will be useful,
//     but WITHOUT ANY WARRANTY; without even the implied warranty of
//     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
//     GNU General Public License for more details.

//     You should have received a copy of the GNU General Public License
//     along with this program; if not, write to the Free Software
//     Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.

// Niels Elgaard Larsen, <URL:mailto:elgaard@diku.dk>
// <URL:http://www.diku.dk/users/elgaard/>

// Garmin communication code is based on Gpstrans by Carsten Tschach
// (tschach@zedat.fu-berlin.de)

import  java.util.Date;


class Sendgpsinfo implements Runnable{

  int ptype;
  static byte  newTrack;
  static byte  message[] = new byte[100];
  Prefs gFilePrefs;

  Sendgpsinfo(int pt){
    ptype =pt;
  }

  static void sendGPSOff()
  {
    int         err;

    if (!Garmincomm.CheckGPS()) {
      CAux.perr("GPS is not responding - make sure it is on and set  to GRMN/GRMN protocol.",4);
    }

    if ((err = Garmincomm.serialOpen(Garmincomm.GRM_comm)) != 0) {
      CAux.perr( "The port initialization  has failed.",4);
      // Continue. Netscape/IE problem
    }
    Garmincomm.sendGPSMessage(Gpsmessage.off1, 4);

    Garmincomm.serialClose();
  }


  public void run() {
    int  recs, processed = 0;
    int  err;
    int result    = 1;
    String   rType ="?";
    byte   term[]= null;
    Thread thisThread = Thread.currentThread();


    if (!Garmincomm.CheckGPS()) {
      CAux.perr("GPS is not responding - make sure it is on and set  to GRMN/GRMN protocol.",4);
    }

    if ((err = Garmincomm.serialOpen(Garmincomm.GRM_comm)) != 0) {
      CAux.perr("The port initialization of " + ptype +" has failed.",4);
      // Continue. Netscape/IE problem
    }

    recs = records(ptype);

    CAux.perr("sending "+ recs + " records",1);
    if (sendRecords(recs) > 0) {
      if (ptype== Gpsmessage.ALMANAC) {
      } else if (ptype== Gpsmessage.ROUTE){
        WayPoint wp;
        int nw;
        Route rt;
        int nr;
        rType = "routes";
        term = Gpsmessage.rtet;
        CAux.perr("Route",1);

        for (nr=0 ; nr<RouteC.nRT && GPS.GMThread==thisThread; nr++){
          rt = RouteC.routes[nr];
          result = doRoute(rt,  nr);

          for (nw=0; nw < rt.wpts.nWP && GPS.GMThread==thisThread; nw++){
            wp=rt.wpts.wayPoints[nw];
            result = doWaypoint(Gpsmessage.ROUTE, wp);
          }
        }
      } else if (ptype == Gpsmessage.TRACK){
        int nt;

        rType = "track";
        term = Gpsmessage.trkt;
        newTrack = (byte) 1;

        for (nt=0; nt < TrackC.nTR && GPS.GMThread==thisThread; nt++) {
          if (TrackC.track[nt]==null || TrackC.track[nt].tpos==null) {
            newTrack = (byte) 1;
          } else {
            CAux.perr("TR "+nt,2);
            result = doTrack(TrackC.track[nt]);
          }
        }
      } else if (ptype == Gpsmessage.WAYPOINT){
        int nw;
        rType = "waypoint";
        term = Gpsmessage.wptt;
        for (nw=0 ; nw<aWP.theWP.nWP && GPS.GMThread==thisThread ; nw++){
            result = doWaypoint(Gpsmessage.WAYPOINT,aWP.theWP.wayPoints[nw]);
        }
      }

      if (result != 0) {
        CAux.perr("Final send F GPSM " + result,3);
        Garmincomm.sendGPSMessage(term, 4);

        if (Gpsmessage.isDEBUG()){
          CAux.perr("Final responce",1);
        }
        Garmincomm.getGPSMessage();

        CAux.perr(recs+" "+rType +
                  " packets were transfered to the GPS receiver",2);
      }
  }

    Garmincomm.serialClose();
  }



  static int doWaypoint( int ptype, WayPoint wp) {
    double  latitude, longitude, x, y;
    long  lat, lon ,dat;
    short   zone;
    String    bgzone; //5
    Date dt;
    int ii;
    String  nsZone; //20
    Pos trans = wp.wpos.toDatum(Pos.WGS84);
    CAux.perr("doWaypoint: " + wp,2);

    dt = wp.timestamp;

    latitude = trans.y.p;
    longitude = trans.x.p;;

    lat = Gpsmessage.deg2int(latitude);
    lon = Gpsmessage.deg2int(longitude);
    dat = CAux.dt2usecs(dt,0)/1000L;

    if (ptype == Gpsmessage.WAYPOINT){
      message[0] = Gpsmessage.WPT;
    }  else {
      message[0] = Gpsmessage.RTE_WPT;
    }

    message[1] = (byte)58;

    cpystr(message, wp.name, 2,6);
    copyNumber(message,8, lat);
    copyNumber(message,12, lon);
    copyNumber(message,16, dat);
    //fileData[strlen(fileData)-1] = 0;
    cpystr(message, wp.comment, 20,40);

    //System.out.println(" lng = " + longitude + " t=" + lon + "  c2=" +
    //              message[12]+" " +message[13]+" " + message[14]+" "+message[15]);

    Garmincomm.sendAndGetMessage(message, 60);
    return 1;
  }


  static int doTrack(TRPos tr)
  {
    double  latitude, longitude, x, y;
    long    lat, lon, dat;
    short   zone;
    Date dt;
    char     nsZone;
    Pos trans = tr.tpos.toDatum(Pos.WGS84);

    dt = tr.tm;

    latitude = trans.y.p;
    longitude = trans.x.p;;

    lat = Gpsmessage.deg2int(latitude);
    lon = Gpsmessage.deg2int(longitude);
    dat = (CAux.dt2usecs(dt, 0)/1000L);
    CAux.perr("dat="+dat ,3);
    message[0] = (byte) 0x22;

    message[1] = (byte)13;

    copyNumber(message,2, (int)lat);
    copyNumber(message,6, (int)lon);
    copyNumber(message,10, dat);

    message[14] = newTrack;
    newTrack    = (byte) 0;

    Garmincomm.sendGPSMessage(message, 15);


    return Garmincomm.getGPSMessage();
  }


static int doRoute(Route rt, int route)
{
  if (Gpsmessage.DEBUG){
    CAux.perr("do Route " + route, 2);
  }


  message[0] = (byte)0x1d;


  message[1] = (byte)21;


  message[2] =(byte) route;
  //printf("rt=%d\n",route);
  cpystr(message, rt.name, 3,20);

    //  printf("send to unit\n");

  Garmincomm.sendGPSMessage(message, 23);

  if (Gpsmessage.DEBUG) {
    //printf("sgp\n");
  }


  return Garmincomm.getGPSMessage();
}



static int doAlmanac()
{
  return (0);
}


static int records(int ptype)
{


  if (ptype ==Gpsmessage.ALMANAC) {
    CAux.perr("Amanac not yet implemnted",9);
  } else if (ptype ==Gpsmessage.ROUTE) {
    int nr,nrec=RouteC.nRT;
    for (nr=0 ; nr<RouteC.nRT ; nr++){
      nrec += RouteC.routes[nr].wpts.nWP;
    }
    return(nrec);
  } else if (ptype ==Gpsmessage.TRACK) {
    int nt,nrec=0;
    for (nt=0; nt < TrackC.nTR; nt++){
      if (TrackC.track[nt]!=null) {
        nrec++;
      }
    }
    return(nrec);
  } else if (ptype ==Gpsmessage.WAYPOINT) {
    return(aWP.theWP.nWP);
  }

  return (-1);
}


static int sendRecords(int recs)
{
  int  result;


  message[0] = Gpsmessage.NUMREC;


  message[1] = 0x02;


  message[2] = (byte)(recs % 256);
  message[3] = (byte)(recs / 256);

  Garmincomm.sendGPSMessage(message, 4);

  result = Garmincomm.getGPSMessage();
  return result;
}


static void copyNumber(byte p[], int st, long n0)
{
  long p0,p1,p2,p3,n;

  if (n0>=0) {
    n=n0;
  } else {
    n=0x1000000000L + n0;
  }


  p3 =   n/0x1000000L;
  p2 = (n-p3*0x1000000L)/0x10000L;
  p1 = (n - p3*0x1000000L - p2*0x10000L)/0x100L;
  p0 = n - p1*0x100L - p2*0x10000L -p3*0x1000000L;

  //System.out.println("p0= " + p0 + " p1=" + p1+ "  p2=" + p2 + "  p3=" + p3);

  p[st+3] = (byte)p3;
  p[st+2] = (byte)p2;
  p[st+1] = (byte)p1;
  p[st  ] = (byte)p0;

}


static void cpystr(byte p[], String q, int st, int n)
{
  int ix=0;

  while (ix<n && ix < q.length()) {
    p[st+ix] = (byte)q.charAt(ix);
    ix ++;
}
  while (ix<n) {
    p[st+ix] = 32;
    ix++;
  }
}
}