/*
 *  acm : an aerial combat simulator for X
 *  Copyright (C) 1991-1998  Riley Rainey
 *
 *  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; version 2 dated June, 1991.
 *
 *  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.
 */

#include <math.h>
#include "pm.h"
#include "hsi.h"
#include <stdio.h>
#ifdef AFDS
#include <afds.h>
#endif

#define CDI_DOT_SPACE	0.125	/* must agree with tools/hsi_header.c */
#define GS_DOT_SPACE	0.35
#define FREQ_X		0.8
#define FREQ_Y		1.1
#define DME_X		-1.0
#define DME_Y		-1.1

/*  There's a bug lurking here, but for now ... */

#ifdef WIN32
#define SCALE_1		5.0
#else
#define SCALE_1		8.5
#endif

void      doHSICompassCard(craft * c, viewer * u);
extern double radial(navaid_t * n, craft * c, VPoint * vec);
extern double glideSlopeOffset(navaid_t * n, craft * c);
extern void ShortTransform(short_point_t *, short_matrix_t * m, short_point_t * b);
extern void VMatrixToShortMatrix(VMatrix * v, short_matrix_t * s);
extern double magHeading(craft *);

void
doHSI(craft * c, viewer * u)
{

	if (c->radarMode != RM_ILS)
		return;

	doHSICompassCard(c, u);
	return;

}

void
doHSICompassCard(craft * c, viewer * u)
{

	XSegment  seg[1024], m_seg[256];
	XRectangle rect[1];
	int       npath, m_i = 0, i = 0, j, k, kmax, xc, yc, h, x, y;
	int       vor_orientation;
	VMatrix   m;
	VPoint    rloc, xobs;
	short_matrix_t im;
	short_point_t it1, it2;
	VGlyphVertex3 jt1, jt2;
	int       xscale, yscale, xoffset, icdi_offset, igs_offset;
	double    cdi_offset, gs_offset, obs, r, diff, adiff, so, co;
	static ZInfo z;

	rect[0].x = u->rx;
	rect[0].y = u->ry;
	rect[0].width = u->radarWidth;
	rect[0].height = u->radarHeight;

	z.depth = --u->v->depth;
	z.color = u->v->pixel[radarBackgroundColor->cIndex];
	FillRectangle(u->v->w, u->rx, u->ry,
				  u->radarWidth, u->radarWidth, &z);

	xoffset = (int) ((-15.0 * u->scaleFactor) + 0.5);
	xc = u->rx + (u->radarWidth + 1) / 2 + xoffset;
	yc = u->ry + (u->radarHeight + 1) / 2;

/*
 *  Build a transformation matrix to be used to display the compass card.
 */

	VIdentMatrix(&m);
	VRotate(&m, XRotation, magHeading(c));
	VMatrixToShortMatrix(&m, &im);

        xscale = 80 * u->scaleFactor;
        yscale = 80 * u->scaleFactor;

	h = (int) (8.0 * u->scaleFactor + 0.5);
        x = FREQ_X * xscale;
        y = FREQ_Y * yscale;
	VDrawStrokeString(u->v, x + xc, y + yc, c->hsiSelect->freq_readout,
					  strlen(c->hsiSelect->freq_readout), h, &u->z);

	if (c->hsiSelect->station &&
		(c->hsiSelect->station->flags & NAVAID_DME)) {
                x = DME_X * xscale;
                y = DME_Y * yscale;
		VDrawStrokeString(u->v, x + xc, y + yc,
						  c->hsiSelect->dme_readout,
						  strlen(c->hsiSelect->dme_readout), h, &u->z);
	}

/*
 *  Our compass card structure is a list of point paths on a unit circle.
 *  Traverse that structure, transforming each set of points into screen
 *  coordinates, and add a segment entry for each one that'll be displayed.
 */

	npath = sizeof(heading_path) / sizeof(heading_path[0]);

	for (i = 0, j = 0; j < npath; ++j) {
		k = heading_path[j].vertex_start;
		ShortTransform((short_point_t *) &heading_vertex[k], &im, &it1);
		kmax = k + heading_path[j].vertex_count;
		for (++k; k < kmax; ++k) {
			ShortTransform((short_point_t *) &heading_vertex[k], &im, &it2);
			seg[i].x1 = xc + (xscale * it1.y / it1.x);
			seg[i].y1 = yc - (yscale * it1.z / it1.x);
			seg[i].x2 = xc + (xscale * it2.y / it2.x);
			seg[i++].y2 = yc - (yscale * it2.z / it2.x);
			it1 = it2;
		}
	}

/*
 *  Draw the legend
 */

	npath = sizeof(legend_path) / sizeof(legend_path[0]);

	for (j = 0; j < npath; ++j) {
		k = legend_path[j].vertex_start;
		jt1 = legend_vertex[k];
		kmax = k + legend_path[j].vertex_count;
		for (++k; k < kmax; ++k) {
			jt2 = legend_vertex[k];
			seg[i].x1 = xc + (xscale * jt1.y / jt1.x);
			seg[i].y1 = yc - (yscale * jt1.z / jt1.x);
			seg[i].x2 = xc + (xscale * jt2.y / jt2.x);
			seg[i++].y2 = yc - (yscale * jt2.z / jt2.x);
			jt1 = jt2;
		}
	}

/*
 *  Build a transformation matrix to be used to display the selected course
 *  pointer.
 */

	VIdentMatrix(&m);
	obs = DEGtoRAD(c->hsiSelect->obs_setting);
	VRotate(&m, XRotation, magHeading(c) - obs);
	VMatrixToShortMatrix(&m, &im);

/*
 *  Draw the Selected Course Pointer
 */

	npath = sizeof(scp_path) / sizeof(scp_path[0]);

	for (j = 0; j < npath; ++j) {
		k = scp_path[j].vertex_start;
		ShortTransform((short_point_t *) &scp_vertex[k], &im, &it1);
		kmax = k + scp_path[j].vertex_count;
		for (++k; k < kmax; ++k) {
			ShortTransform((short_point_t *) &scp_vertex[k], &im, &it2);
			seg[i].x1 = xc + (xscale * it1.y / it1.x);
			seg[i].y1 = yc - (yscale * it1.z / it1.x);
			seg[i].x2 = xc + (xscale * it2.y / it2.x);
			seg[i++].y2 = yc - (yscale * it2.z / it2.x);
			it1 = it2;
		}
	}

/*
 *  Draw the Course Deviation Indicator
 */

	if (c->hsiSelect->station != NULL) {

		r = radial(c->hsiSelect->station, c, &rloc);

		if (c->hsiSelect->station->flags & NAVAID_LOC) {
			diff = atan2(rloc.y, rloc.x);
		}
		else {
			co = cos(obs);
			so = sin(obs);
			xobs.x = co * rloc.x + so * rloc.y;
			xobs.y = -so * rloc.x + co * rloc.y;
			diff = atan2(xobs.y, xobs.x);
		}

		if (diff > pi / 2.0) {
			adiff = pi - diff;
		}
		else if (diff < -pi / 2.0) {
			adiff = -pi - diff;
		}
		else {
			adiff = diff;
		}

#ifdef AFDS
		AFDSSetTrackingParameters ( c, RADtoDEG(obs), RADtoDEG(adiff) );
#endif

/*


 *  Full localizer/SDF offsets will vary based on the beam width of the
 *  transmitter (typical localizer values are 3 to 6 degrees).
 *
 *  VOR offsets are 1.7 degrees per dot on the HSI.
 */

#define CDI_MAX	5.0

		if (c->hsiSelect->station->flags & NAVAID_LOC) {
			vor_orientation = 0;
			cdi_offset = CDI_MAX * 2.0 * adiff /
				c->hsiSelect->station->beam_width;
		}
		else {
			vor_orientation = (fabs(diff) > pi / 2.0) ? 1 : -1;
			cdi_offset = -adiff / DEGtoRAD(1.7);
		}

		if (cdi_offset > CDI_MAX)
			icdi_offset = (int) (UNITY * CDI_MAX * CDI_DOT_SPACE);
		else if (cdi_offset < -CDI_MAX)
			icdi_offset = (int) (UNITY * -CDI_MAX * CDI_DOT_SPACE);
		else
			icdi_offset = (int) (UNITY * cdi_offset * CDI_DOT_SPACE);

		npath = sizeof(cdi_path) / sizeof(cdi_path[0]);

		for (j = 0; j < npath; ++j) {
			k = cdi_path[j].vertex_start;
			jt1 = cdi_vertex[k];
			jt1.y += icdi_offset;
			ShortTransform((short_point_t *) &jt1, &im, &it1);
			kmax = k + cdi_path[j].vertex_count;
			for (++k; k < kmax; ++k) {
				jt1 = cdi_vertex[k];
				jt1.y += icdi_offset;
				ShortTransform((short_point_t *) &jt1, &im, &it2);
				m_seg[m_i].x1 = xc + (xscale * it1.y / it1.x);
				m_seg[m_i].y1 = yc - (yscale * it1.z / it1.x);
				m_seg[m_i].x2 = xc + (xscale * it2.y / it2.x);
				m_seg[m_i++].y2 = yc - (yscale * it2.z / it2.x);
				it1 = it2;
			}
		}

		if (vor_orientation != 0) {

			npath = sizeof(vor_to_from_path) /
				sizeof(vor_to_from_path[0]);

			for (j = 0; j < npath; ++j) {
				k = vor_to_from_path[j].vertex_start;
				jt1 = vor_to_from_vertex[k];
				jt1.z *= vor_orientation;
				ShortTransform((short_point_t *) &jt1, &im, &it1);
				kmax = k + vor_to_from_path[j].vertex_count;
				for (++k; k < kmax; ++k) {
					jt1 = vor_to_from_vertex[k];
					jt1.z *= vor_orientation;
					ShortTransform((short_point_t *) &jt1, &im, &it2);
					seg[i].x1 = xc + (xscale * it1.y / it1.x);
					seg[i].y1 = yc - (yscale * it1.z / it1.x);
					seg[i].x2 = xc + (xscale * it2.y / it2.x);
					seg[i++].y2 = yc - (yscale * it2.z / it2.x);
					it1 = it2;
				}
			}
		}

/*
 *  Draw the Glide Slope scale
 */

		if (c->hsiSelect->station->flags & NAVAID_GS) {

			npath = sizeof(gs_scale_path) / sizeof(gs_scale_path[0]);

			for (j = 0; j < npath; ++j) {
				k = gs_scale_path[j].vertex_start;
				jt1 = gs_scale_vertex[k];
				kmax = k + gs_scale_path[j].vertex_count;
				for (++k; k < kmax; ++k) {
					jt2 = gs_scale_vertex[k];
					seg[i].x1 = xc + (xscale * jt1.y / jt1.x);
					seg[i].y1 = yc - (yscale * jt1.z / jt1.x);
					seg[i].x2 = xc + (xscale * jt2.y / jt2.x);
					seg[i++].y2 = yc - (yscale * jt2.z / jt2.x);
					jt1 = jt2;
				}
			}

/*
 *  Draw the Glide Slope Deviation Indicator
 */

			gs_offset = RADtoDEG(
					  glideSlopeOffset(c->hsiSelect->station, c)) / 0.35;

			if (gs_offset > 2.5)
				igs_offset = (int) (UNITY * (2.5 * GS_DOT_SPACE));
			else if (gs_offset < -2.5)
				igs_offset = (int) (UNITY * (-2.5 * GS_DOT_SPACE));
			else
				igs_offset = (int) (UNITY * (gs_offset * GS_DOT_SPACE));

			npath = sizeof(gs_pointer_path) /
				sizeof(gs_pointer_path[0]);

			for (j = 0; j < npath; ++j) {
				k = gs_pointer_path[j].vertex_start;
				jt1 = gs_pointer_vertex[k];
				jt1.z += igs_offset;
				kmax = k + gs_pointer_path[j].vertex_count;
				for (++k; k < kmax; ++k) {
					jt2 = gs_pointer_vertex[k];
					jt2.z += igs_offset;
					m_seg[m_i].x1 = xc + (xscale * jt1.y / jt1.x);
					m_seg[m_i].y1 = yc - (yscale * jt1.z / jt1.x);
					m_seg[m_i].x2 = xc + (xscale * jt2.y / jt2.x);
					m_seg[m_i++].y2 = yc - (yscale * jt2.z / jt2.x);
					jt1 = jt2;
				}
			}

		}
	}

	u->v->w->clip.x1 = rect[0].x;
	u->v->w->clip.y1 = rect[0].y;
	u->v->w->clip.x2 = rect[0].x + rect[0].width - 1;
	u->v->w->clip.y2 = rect[0].y + rect[0].height - 1;

	VDrawSegments(u->v, m_seg, m_i, u->v->pixel[HSIMagentaColor->cIndex]);
	VDrawSegments(u->v, seg, i, u->v->pixel[HUDPixel]);

	u->v->w->clip.x1 = 0;
	u->v->w->clip.y1 = 0;
	u->v->w->clip.x2 = u->v->w->width - 1;
	u->v->w->clip.y2 = u->v->w->height - 1;

	return;
}