#include <stdio.h>
#include <string.h>
#include <stdlib.h>
#include <math.h>
#include <time.h>
#include <getopt.h>
#include "sgdp4h.h"

#define LIM 128
#define D2R M_PI/180.0
#define R2D 180.0/M_PI
#define XKMPER 6378.135		// Earth radius in km

long Isat = 0;
long Isatsel = 0;
extern double SGDP4_jd0;
struct map
{
  long satno;
  double mjd;
  char nfd[LIM], tlefile[LIM], observer[32];
  char datadir[LIM], tledir[LIM];
} m;


// Compute Julian Day from Date
double
date2mjd (int year, int month, double day)
{
  int a, b;
  double jd;

  if (month < 3)
    {
      year--;
      month += 12;
    }

  a = floor (year / 100.);
  b = 2. - a + floor (a / 4.);

  if (year < 1582)
    b = 0;
  if (year == 1582 && month < 10)
    b = 0;
  if (year == 1582 && month == 10 && day <= 4)
    b = 0;

  jd =
    floor (365.25 * (year + 4716)) + floor (30.6001 * (month + 1)) + day + b -
    1524.5;

  return jd - 2400000.5;
}

// nfd2mjd
double
nfd2mjd (char *date)
{
  int year, month, day, hour, min, sec;
  double mjd, dday;

  sscanf (date, "%04d-%02d-%02dT%02d:%02d:%02d", &year, &month, &day, &hour,
	  &min, &sec);
  dday = day + hour / 24.0 + min / 1440.0 + sec / 86400.0;

  mjd = date2mjd (year, month, dday);

  return mjd;
}

void
usage ()
{
  printf ("Usage goes here.\n");

  return;
}


// Return x modulo y [0,y)
double
modulo (double x, double y)
{
  x = fmod (x, y);
  if (x < 0.0)
    x += y;

  return x;
}

// Greenwich Mean Sidereal Time
double
gmst (double mjd)
{
  double t, gmst;

  t = (mjd - 51544.5) / 36525.0;

  gmst =
    modulo (280.46061837 + 360.98564736629 * (mjd - 51544.5) +
	    t * t * (0.000387933 - t / 38710000), 360.0);

  return gmst;
}

// Present nfd
void
nfd_now (char *s)
{
  time_t rawtime;
  struct tm *ptm;

  // Get UTC time
  time (&rawtime);
  ptm = gmtime (&rawtime);

  sprintf (s, "%04d-%02d-%02dT%02d:%02d:%02d", ptm->tm_year + 1900,
	   ptm->tm_mon + 1, ptm->tm_mday, ptm->tm_hour, ptm->tm_min,
	   ptm->tm_sec);

  return;
}

// Compute longitude
void
compute_longitude (char *tlefile, long satno, double mjd)
{
  FILE *fp = NULL;
  orbit_t orb;
  xyz_t satpos, satvel;
  double jd, h, l, b, r;
  long imode;

  // Open TLE file
  fp = fopen (tlefile, "rb");
  if (fp == NULL)
    fatal_error ("File open failed for reading \"%s\"", tlefile);

  // Loop over elements
  while (read_twoline (fp, satno, &orb) == 0)
    {
      Isat = orb.satno;
      imode = init_sgdp4 (&orb);
      if (imode == SGDP4_ERROR)
	continue;

      // Skip objects with mean motions outside of 0.8 to 1.2 revs/day
      if (orb.rev < 0.8 || orb.rev > 1.2)
	continue;

      // Get Julian Date
      jd = mjd + 2400000.5;

      // Get positions
      satpos_xyz (jd, &satpos, &satvel);

      // Greenwich Mean Sidereal time
      h = gmst (mjd);

      // Celestial position
      r =
	sqrt (satpos.x * satpos.x + satpos.y * satpos.y +
	      satpos.z * satpos.z);
      l = atan2 (satpos.y, satpos.x) * R2D;
      l = modulo (l - h, 360.0);
      b = asin (satpos.z / r) * R2D;
      if (l > 180.0)
	l -= 360.0;
      if (l < -180.0)
	l += 360.0;

      printf ("%05d %10s %8.3lf %8.3lf %6.0lf\n", orb.satno, orb.desig, l, b,
	      r - XKMPER);
    }
  fclose (fp);

  return;
}

int
main (int argc, char *argv[])
{
  int arg = 0;
  long satno = 0;
  double mjd;
  char nfd[LIM], tlefile[LIM];

  nfd_now (nfd);
  mjd = nfd2mjd (nfd);


  // Decode options
  if (argc > 1)
    {
      while ((arg = getopt (argc, argv, "t:c:i:h")) != -1)
	{
	  switch (arg)
	    {

	    case 't':
	      strcpy (nfd, optarg);
	      mjd = nfd2mjd (nfd);
	      break;

	    case 'c':
	      strcpy (tlefile, optarg);
	      break;

	    case 'i':
	      satno = atoi (optarg);
	      break;

	    case 'h':
	      usage ();
	      return 0;
	      break;

	    default:
	      usage ();
	      return 0;
	    }
	}
    }
  else
    {
      usage ();
      return 0;
    }

  // Compute longitudes of satellites
  compute_longitude (tlefile, satno, mjd);

  return 0;
}