/*****************************************************************************
 *  Copyright (c) 2008, University of Florida.
 *  All rights reserved.
 *  
 *  This file is part of OpenJAUS.  OpenJAUS is distributed under the BSD 
 *  license.  See the LICENSE file for details.
 * 
 *  Redistribution and use in source and binary forms, with or without 
 *  modification, are permitted provided that the following conditions 
 *  are met:
 *
 *     * Redistributions of source code must retain the above copyright
 *       notice, this list of conditions and the following disclaimer.
 *     * Redistributions in binary form must reproduce the above
 *       copyright notice, this list of conditions and the following
 *       disclaimer in the documentation and/or other materials provided
 *       with the distribution.
 *     * Neither the name of the University of Florida nor the names of its 
 *       contributors may be used to endorse or promote products derived from 
 *       this software without specific prior written permission.
 *
 *   THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS 
 *   "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 
 *   LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR 
 *   A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT 
 *   OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL,
 *   SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT 
 *   LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 
 *   DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 
 *   THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
 *   (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE 
 *   OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 ****************************************************************************/
// File Name: greatCircle.h
//
// Written By: Tom Galluzzo (galluzzo AT gmail DOT com) and Danny Kent (jaus AT dannykent DOT com)
//
// Version: 3.2
//
// Date: 08/04/06
//
// Description: This file describes the functions that comprise great circle calculations. These provide 
// a converstion method from Latitude and Longitude to Meters based on the approximation that the circumference 
// of the earth is a great circle.

#if defined(WIN32)
	#define _USE_MATH_DEFINES
#endif

#include <math.h>
#include "utm/utmLib.h"

double greatCircleDistance(double lat1, double lon1, double lat2, double lon2)
{
  static double d;

  lon1 = -lon1;
  lon2 = -lon2;
  d = 2*asin( sqrt( pow( sin((lat1-lat2)/2), 2.0 ) + cos(lat1)*cos(lat2)*pow(sin((lon1-lon2)/2),2.0)));
  return GREAT_CIRCLE_EARTH_RADIUS_M*d;
}

double greatCircleCourse(double lat1, double lon1, double lat2, double lon2)
{
  lon1 = -lon1;
  lon2 = -lon2;
  return fmod(atan2(sin(lon1-lon2)*cos(lat2),cos(lat1)*sin(lat2)-sin(lat1)*cos(lat2)*cos(lon1-lon2)), 2*M_PI);
}

double greatCircleLat(double lat1, double d, double tc)
{
  d /= GREAT_CIRCLE_EARTH_RADIUS_M;
  return asin(sin(lat1)*cos(d)+cos(lat1)*sin(d)*cos(tc));
}

double greatCircleLon(double lat1, double lon1, double d, double tc)
{
  lon1 = -lon1;
  d /= GREAT_CIRCLE_EARTH_RADIUS_M;
  return -(fmod(lon1-asin(sin(tc)*sin(d)/cos(lat1))+M_PI,2*M_PI)-M_PI);
}