// xpcPluginTools functions to support xpcPlugin
//
//  FUNCTIONS
//      buildXPLMDataRefs
//      fmini
//      almostequal
//      updateLog
//      handleDREFSIM
//      getIP
//      printBuffertoLog
//      test
//      testi
//
//  CONTACT
//      For questions email Christopher Teubert (christopher.a.teubert@nasa.gov)
//
//	CONTRIBUTORS
//		CT: Christopher Teubert (christopher.a.teubert@nasa.gov)
//
//  TO DO:
//      1. Support sending -1 length to updateLog for it to calculate intself (look for /0)
//      2. Have printbuffertolog run parse function
//      3. Builddatarefs: Fill out & test options
//
//  BEGIN CODE

#include "Log.h"
#include <stdlib.h>
#include <stdio.h>
#include <string.h>
#include <stdarg.h>
#include <math.h>
#include "xpcPluginTools.h"

XPLMDataRef XPLMDataRefs[134][8];
XPLMDataRef multiplayer[20][17];
XPLMDataRef AIswitch;

void buildXPLMDataRefs()
{
    int i, j;
    char multi[50] = {0};
    
    for (i=0; i<134; i++)
    {
        for (j=0; j<8; j++)
        {
            XPLMDataRefs[i][j] = XPLMFindDataRef("sim/test/test_float");
        }
    }
    
    /* Prefetch the sim variables we will use. */
	//Row 0: Frame Rates
	
	//Row 1: Times
    XPLMDataRefs[1][1] = XPLMFindDataRef("sim/time/total_running_time_sec");
    XPLMDataRefs[1][2] = XPLMFindDataRef("sim/time/total_flight_time_sec");
    XPLMDataRefs[1][3] = XPLMFindDataRef("sim/time/timer_elapsed_time_sec");
	
    //cockpit2/clock_time/zulu_time_hours
    //cockpit2/clock_time/zulu_time_minutes
    //cockpit2/clock_time/zulu_time_seconds
	
	//cockpit2/clock_time/local_time_hours
	
	//cockpit2/clock_time/hobbs_time_hours
	
	//Row 2: Sim Stats
	
	//Row 3: Velocities
    //READ ONLY
    XPLMDataRefs[3][0] = XPLMFindDataRef("sim/flightmodel/position/indicated_airspeed"); //Vind knots indicated airspeed TEST
	
    //Vind knots equivilent airspeed (considering compressible flow)
    XPLMDataRefs[3][2] = XPLMFindDataRef("sim/flightmodel/position/true_airspeed"); //Vtrue knots true airspeed
    XPLMDataRefs[3][3] = XPLMFindDataRef("sim/flightmodel/position/groundspeed"); //Vtrue Knots true ground speed
	
    //XPLMDataRefs[3][5] = Vind mph
    //XPLMDataRefs[3][6] = Vtrue mphas
    //XPLMDataRefs[3][7] = Vtre mphgs
	
	//Row 4: Mach, VVI, G-loads
    XPLMDataRefs[4][0] = XPLMFindDataRef("sim/flightmodel/misc/machno"); // Mach Number
    XPLMDataRefs[4][4] = XPLMFindDataRef("sim/flightmodel2/misc/gforce_normal");
    XPLMDataRefs[4][5] = XPLMFindDataRef("sim/flightmodel2/misc/gforce_axial");
    XPLMDataRefs[4][6] = XPLMFindDataRef("sim/flightmodel2/misc/gforce_side");
	
	//Row 5: Atmosphere: Weather
    XPLMDataRefs[5][0] = XPLMFindDataRef("sim/weather/barometer_sealevel_inhg");
    XPLMDataRefs[5][1] = XPLMFindDataRef("sim/weather/temperature_sealevel_c");
    XPLMDataRefs[5][3] = XPLMFindDataRef("sim/cockpit2/gauges/indicators/wind_speed_kts");
	
	//Row 6: Atmosphere: Aircraft
	
	//Row 7: System Pressures
	
	//Row 8: Joystick
    XPLMDataRefs[8][0] = XPLMFindDataRef("sim/joystick/yoke_pitch_ratio");
    XPLMDataRefs[8][1] = XPLMFindDataRef("sim/joystick/yoke_roll_ratio");
    XPLMDataRefs[8][2] = XPLMFindDataRef("sim/joystick/yoke_heading_ratio");
	
	//Row 9: Other Flight Controls
	
	//Row 10: Art stab ail/elv/rud
	
    //Row 11: Control Surfaces
    XPLMDataRefs[11][0] = XPLMFindDataRef("sim/cockpit2/controls/yoke_pitch_ratio"); //Elevator Position
    XPLMDataRefs[11][1] = XPLMFindDataRef("sim/cockpit2/controls/yoke_roll_ratio"); //Aileron Position
    XPLMDataRefs[11][2] = XPLMFindDataRef("sim/cockpit2/controls/yoke_heading_ratio"); //Rudder Position
    XPLMDataRefs[11][3] = NULL;
    XPLMDataRefs[11][4] = NULL;
    XPLMDataRefs[11][5] = NULL;
    XPLMDataRefs[11][6] = NULL;
    XPLMDataRefs[11][7] = NULL;
    
	//Row 12: Wing Sweep/Trust Vec
	
	//Row 13: trip/flap/slat/s-brakes
    XPLMDataRefs[13][3] = XPLMFindDataRef("sim/flightmodel/controls/flaprqst");
    XPLMDataRefs[13][4] = XPLMFindDataRef("sim/flightmodel/controls/flaprat");// should be equal to flap2rat
	
    //Row 14: Gear, Brakes
    XPLMDataRefs[14][0] = XPLMFindDataRef("sim/aircraft/parts/acf_gear_deploy"); //Landing Gear-SPECIAL (Float[10])
    XPLMDataRefs[14][1] = XPLMFindDataRef("sim/flightmodel/controls/parkbrake"); //Parking Brake
    XPLMDataRefs[14][2] = XPLMFindDataRef("sim/cockpit2/controls/left_brake_ratio");
    XPLMDataRefs[14][3] = XPLMFindDataRef("sim/cockpit2/controls/right_brake_ratio");
	
    XPLMDataRefs[14][7] = XPLMFindDataRef("sim/cockpit/switches/gear_handle_status"); //Landing Gear Handle
    
	//Row 15: MNR (Angular Moments)
    //READ ONLY
    XPLMDataRefs[15][0] = XPLMFindDataRef("sim/flightmodel/position/M");
    XPLMDataRefs[15][1] = XPLMFindDataRef("sim/flightmodel/position/L");
    XPLMDataRefs[15][2] = XPLMFindDataRef("sim/flightmodel/position/N");
	
    //Row 16: PQR (Angular Velocities)
    XPLMDataRefs[16][0] = XPLMFindDataRef("sim/flightmodel/position/Qrad");
    XPLMDataRefs[16][1] = XPLMFindDataRef("sim/flightmodel/position/Prad");
    XPLMDataRefs[16][2] = XPLMFindDataRef("sim/flightmodel/position/Rrad");
    XPLMDataRefs[16][3] = XPLMFindDataRef("sim/flightmodel/position/Q");
    XPLMDataRefs[16][4] = XPLMFindDataRef("sim/flightmodel/position/P");
    XPLMDataRefs[16][5] = XPLMFindDataRef("sim/flightmodel/position/R");
    
    //Row 17: Orientation: pitch, roll, yaw, heading
    XPLMDataRefs[17][0] = XPLMFindDataRef("sim/flightmodel/position/theta"); //Pitch
    XPLMDataRefs[17][1] = XPLMFindDataRef("sim/flightmodel/position/phi"); //roll
    XPLMDataRefs[17][2] = XPLMFindDataRef("sim/flightmodel/position/psi"); //true heading (where nose is pointing)
    
    //READ ONLY (always)
    XPLMDataRefs[17][3] = XPLMFindDataRef("sim/flightmodel/position/magpsi"); //magnetic heading
    
    //WRITABLE
    XPLMDataRefs[17][4] = XPLMFindDataRef("sim/flightmodel/position/q"); //Quartonian
	
	//Row 18: Orientation: alpha beta hpath vpath slip
    XPLMDataRefs[18][0] = XPLMFindDataRef("sim/flightmodel/position/alpha"); //Angle of Attack
    XPLMDataRefs[18][1] = XPLMFindDataRef("sim/cockpit2/gauges/indicators/sideslip_degrees"); //fix to beta
    XPLMDataRefs[18][2] = XPLMFindDataRef("sim/flightmodel/position/hpath"); //Heading the aircraft flies (velocity vector) TEST
    XPLMDataRefs[18][3] = XPLMFindDataRef("sim/flightmodel/position/vpath"); //VPath TEST
    XPLMDataRefs[18][7] = XPLMFindDataRef("sim/cockpit2/gauges/indicators/sideslip_degrees");
	
	//Row 19: Mag Compass
    XPLMDataRefs[19][0] = XPLMFindDataRef("sim/flightmodel/position/magpsi");
	
    //READ ONLY
    XPLMDataRefs[19][1] = XPLMFindDataRef("sim/flightmodel/position/magnetic_variation");
    
    //Row 20: Global Position
    //READ ONLY
    XPLMDataRefs[20][0] = XPLMFindDataRef("sim/flightmodel/position/latitude"); // Read Only
    XPLMDataRefs[20][1] = XPLMFindDataRef("sim/flightmodel/position/longitude"); // Read Only
    XPLMDataRefs[20][3] = XPLMFindDataRef("sim/flightmodel/position/y_agl"); // Read Only
    
    //Row 21: Local Position, Velocity
    XPLMDataRefs[21][0] = XPLMFindDataRef("sim/flightmodel/position/local_x");
    XPLMDataRefs[21][1] = XPLMFindDataRef("sim/flightmodel/position/local_y");
    XPLMDataRefs[21][2] = XPLMFindDataRef("sim/flightmodel/position/local_z");
    XPLMDataRefs[21][3] = XPLMFindDataRef("sim/flightmodel/position/local_vx");
    XPLMDataRefs[21][4] = XPLMFindDataRef("sim/flightmodel/position/local_vy");
    XPLMDataRefs[21][5] = XPLMFindDataRef("sim/flightmodel/position/local_vz");
    
	//Row 22: All Planes: Lat (READ ONLY)
    XPLMDataRefs[22][0] = XPLMDataRefs[20][0];
    XPLMDataRefs[22][1] = XPLMFindDataRef("sim/multiplayer/position/plane1_lat");
    XPLMDataRefs[22][2] = XPLMFindDataRef("sim/multiplayer/position/plane2_lat");
    XPLMDataRefs[22][3] = XPLMFindDataRef("sim/multiplayer/position/plane3_lat");
    XPLMDataRefs[22][4] = XPLMFindDataRef("sim/multiplayer/position/plane4_lat");
    XPLMDataRefs[22][5] = XPLMFindDataRef("sim/multiplayer/position/plane5_lat");
    XPLMDataRefs[22][6] = XPLMFindDataRef("sim/multiplayer/position/plane6_lat");
    XPLMDataRefs[22][7] = XPLMFindDataRef("sim/multiplayer/position/plane7_lat");
	
	//Row 23: All Planes: Lon
    XPLMDataRefs[23][0] = XPLMDataRefs[20][1];
    XPLMDataRefs[23][1] = XPLMFindDataRef("sim/multiplayer/position/plane1_lon");
    XPLMDataRefs[23][2] = XPLMFindDataRef("sim/multiplayer/position/plane2_lon");
    XPLMDataRefs[23][3] = XPLMFindDataRef("sim/multiplayer/position/plane3_lon");
    XPLMDataRefs[23][4] = XPLMFindDataRef("sim/multiplayer/position/plane4_lon");
    XPLMDataRefs[23][5] = XPLMFindDataRef("sim/multiplayer/position/plane5_lon");
    XPLMDataRefs[23][6] = XPLMFindDataRef("sim/multiplayer/position/plane6_lon");
    XPLMDataRefs[23][7] = XPLMFindDataRef("sim/multiplayer/position/plane7_lon");
	
	//Row 24: All Planes: Alt
    XPLMDataRefs[24][0] = XPLMDataRefs[20][2];
    XPLMDataRefs[24][1] = XPLMFindDataRef("sim/multiplayer/position/plane1_el");
    XPLMDataRefs[24][2] = XPLMFindDataRef("sim/multiplayer/position/plane2_el");
    XPLMDataRefs[24][3] = XPLMFindDataRef("sim/multiplayer/position/plane3_el");
    XPLMDataRefs[24][4] = XPLMFindDataRef("sim/multiplayer/position/plane4_el");
    XPLMDataRefs[24][5] = XPLMFindDataRef("sim/multiplayer/position/plane5_el");
    XPLMDataRefs[24][6] = XPLMFindDataRef("sim/multiplayer/position/plane6_el");
    XPLMDataRefs[24][7] = XPLMFindDataRef("sim/multiplayer/position/plane7_el");
	
    //Row 25: Throttle Command
    XPLMDataRefs[25][0] = XPLMFindDataRef("sim/flightmodel/engine/ENGN_thro"); //Throttle (array 8)
	
	//Row 26: Throttle Actual
    XPLMDataRefs[26][0] = XPLMFindDataRef("sim/flightmodel2/engines/throttle_used_ratio"); // Trottle Actual (array 8) (Read Only)
	
	//Row 27:
    
    
    // Multiplayer
    for ( i = 1; i < 20; i++ )
    {
		sprintf(multi, "sim/multiplayer/position/plane%i_x", i); // X
        multiplayer[i][0] = XPLMFindDataRef(multi);
		sprintf(multi, "sim/multiplayer/position/plane%i_y", i); // Y
        multiplayer[i][1] = XPLMFindDataRef(multi);
        sprintf(multi,"sim/multiplayer/position/plane%i_z", i); // Z
        multiplayer[i][2] = XPLMFindDataRef(multi);
        sprintf(multi,"sim/multiplayer/position/plane%i_the", i); // Theta (Pitch)
        multiplayer[i][3] = XPLMFindDataRef(multi);
        sprintf(multi,"sim/multiplayer/position/plane%i_phi", i); // Phi (Roll)
        multiplayer[i][4] = XPLMFindDataRef(multi);
        sprintf(multi,"sim/multiplayer/position/plane%i_psi", i); // Psi (Heading-True)
		multiplayer[i][5] = XPLMFindDataRef(multi);
		sprintf(multi, "sim/multiplayer/position/plane%i_gear_deploy", i); // Landing Gear
		multiplayer[i][6] = XPLMFindDataRef(multi);
		sprintf(multi, "sim/multiplayer/position/plane%i_flap_ratio", i);
		multiplayer[i][7] = XPLMFindDataRef(multi);
		sprintf(multi, "sim/multiplayer/position/plane%i_flap_ratio2", i);
		multiplayer[i][8] = XPLMFindDataRef(multi);
		sprintf(multi, "sim/multiplayer/position/plane%i_spoiler_ratio", i);
		multiplayer[i][9] = XPLMFindDataRef(multi);
		sprintf(multi, "sim/multiplayer/position/plane%i_speedbrake_ratio", i);
		multiplayer[i][10] = XPLMFindDataRef(multi);
		sprintf(multi, "sim/multiplayer/position/plane%i_slat_ratio", i);
		multiplayer[i][11] = XPLMFindDataRef(multi);
		sprintf(multi, "sim/multiplayer/position/plane%i_wing_sweep", i);
		multiplayer[i][12] = XPLMFindDataRef(multi);
		sprintf(multi, "sim/multiplayer/position/plane%i_throttle", i);
		multiplayer[i][13] = XPLMFindDataRef(multi);
		sprintf(multi, "sim/multiplayer/position/plane%i_yolk_pitch", i);
		multiplayer[i][14] = XPLMFindDataRef(multi);
		sprintf(multi, "sim/multiplayer/position/plane%i_yolk_roll", i);
		multiplayer[i][15] = XPLMFindDataRef(multi);
		sprintf(multi, "sim/multiplayer/position/plane%i_yolk_yaw", i);
		multiplayer[i][16] = XPLMFindDataRef(multi);
    }
    AIswitch = XPLMFindDataRef("sim/operation/override/override_plane_ai_autopilot");
}

int fmini(int a, int b)
{
    // Returns the minimum value of two integers
    return ((((a)-(b))&0x80000000) >> 31)? (a) : (b);
}

int almostequal(float arg1, float arg2, float tol)
{
    // Compares arg1 and arg 2. If they are within tol returns true
    return (abs(arg1-arg2)<tol);
}

unsigned short getIP(struct sockaddr recvaddr, char *IP)
{
    // Gets the IP Address from sockaddr
	struct sockaddr_in *sendaddr;
	
	sendaddr = (struct sockaddr_in *) &recvaddr;
	sprintf(IP,"%d.%d.%d.%d",(int) (*sendaddr).sin_addr.s_addr&0xFF, (int) ((*sendaddr).sin_addr.s_addr&0xFF00)>>8, (int) ((*sendaddr).sin_addr.s_addr&0xFF0000)>>16, (int) ((*sendaddr).sin_addr.s_addr&0xFF000000)>>24);
	
	return ntohs((*sendaddr).sin_port);
}

// DEBUGGING TOOLS
// --------------------------------

int test(const char *buffer)
{
    // Prints "test buffer" to log (for debugging)
    char buffer2[95] = {0};
    strncpy(buffer2, buffer, 95);
	
	XPC::Log::FormatLine("[TEST] %s", buffer2);
	
	return 0;
}

int test(int buffer)
{
    // Prints "test #[buffer]" to log (for debugging)
	XPC::Log::FormatLine("[TEST] #%i", buffer);
	
	return 0;
}