/*
 * Copyright (C) 2010 DSD Author
 * GPG Key ID: 0x3F1D7FD0 (74EF 430D F7F2 0A48 FCE6  F630 FAA2 635D 3F1D 7FD0)
 *
 * Permission to use, copy, modify, and/or distribute this software for any
 * purpose with or without fee is hereby granted, provided that the above
 * copyright notice and this permission notice appear in all copies.
 *
 * THE SOFTWARE IS PROVIDED "AS IS" AND ISC DISCLAIMS ALL WARRANTIES WITH
 * REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF MERCHANTABILITY
 * AND FITNESS.  IN NO EVENT SHALL ISC BE LIABLE FOR ANY SPECIAL, DIRECT,
 * INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES WHATSOEVER RESULTING FROM
 * LOSS OF USE, DATA OR PROFITS, WHETHER IN AN ACTION OF CONTRACT, NEGLIGENCE
 * OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE USE OR
 * PERFORMANCE OF THIS SOFTWARE.
 */

#include "dsd.h"
#include "dmr_const.h"
#include "p25p1_check_hdu.h"

void ProcessDMR (dsd_opts * opts, dsd_state * state)
{
  uint32_t i, j;
  uint32_t Frame;
  TimeSlotVoiceSuperFrame_t * TSVoiceSupFrameL = NULL;
  TimeSlotVoiceSuperFrame_t * TSVoiceSupFrameR = NULL;
  TimeSlotVoiceSuperFrame_t * TSVoiceSupFrameRC = NULL; //Reverse Test for MS Backwards

  int *errs;
  int *errs2;
  unsigned long long int k;
  int x;
  k = 0;

  TSVoiceSupFrameL = &state->TS1SuperFrame;
  TSVoiceSupFrameR = &state->TS2SuperFrame;

int Pr[256] = {
  0x0000, 0x1F00, 0xE300, 0xFC00, 0x2503, 0x3A03, 0xC603, 0xD903,
  0x4A05, 0x5505, 0xA905, 0xB605, 0x6F06, 0x7006, 0x8C06, 0x9306,
  0x2618, 0x3918, 0xC518, 0xDA18, 0x031B, 0x1C1B, 0xE01B, 0xFF1B,
  0x6C1D, 0x731D, 0x8F1D, 0x901D, 0x491E, 0x561E, 0xAA1E, 0xB51E, //31
  0x4B28, 0x5428, 0xA828, 0xB728, 0x6E2B, 0x712B, 0x8D2B, 0x922B,
  0x012D, 0x1E2D, 0xE22D, 0xFD2D, 0x242E, 0x3B2E, 0xC72E, 0xD82E,
  0x6D30, 0x7230, 0x8E30, 0x9130, 0x4833, 0x5733, 0xAB33, 0xB433,
  0x2735, 0x3835, 0xC435, 0xDB35, 0x0236, 0x1D36, 0xE136, 0xFE36, //63
  0x2B49, 0x3449, 0xC849, 0xD749, 0x0E4A, 0x114A, 0xED4A, 0xF24A,
  0x614C, 0xAE4C, 0x824C, 0x9D4C, 0x444F, 0x5B4F, 0xA74F, 0xB84F,
  0x0D51, 0x1251, 0xEE51, 0xF151, 0x2852, 0x3752, 0xCB52, 0xD452,
  0x4754, 0x5854, 0xA454, 0xBB54, 0x6257, 0x7D57, 0x8157, 0x9E57, //95
  0x6061, 0x7F61, 0x8361, 0x9C61, 0x4562, 0x5A62, 0xA662, 0xB962,
  0x2A64, 0x3564, 0xC964, 0xD664, 0x0F67, 0x1067, 0xEC67, 0xF367,
  0x4679, 0x5979, 0xA579, 0xBA79, 0x637A, 0x7C7A, 0x807A, 0x9F7A,
  0x0C7C, 0x137C, 0xEF7C, 0xF07C, 0x297F, 0x367F, 0xCA7F, 0xD57F, //127
  0x4D89, 0x5289, 0xAE89, 0xB189, 0x688A, 0x778A, 0x8B8A, 0x948A,
  0x078C, 0x188C, 0xE48C, 0xFB8C, 0x228F, 0x3D8F, 0xC18F, 0xDE8F,
  0x6B91, 0x7491, 0x8891, 0x9791, 0x4E92, 0x5192, 0xAD92, 0xB292,
  0x2194, 0x3E94, 0xC294, 0xDD94, 0x0497, 0x1B97, 0xE797, 0xF897, //159
  0x06A1, 0x19A1, 0xE5A1, 0xFAA1, 0x23A2, 0x3CA2, 0xC0A2, 0xDFA2,
  0x4CA4, 0x53A4, 0xAFA4, 0xB0A4, 0x69A7, 0x76A7, 0x8AA7, 0x95A7,
  0x20B9, 0x3FB9, 0xC3B9, 0xDCB9, 0x05BA, 0x1ABA, 0xE6BA, 0xF9BA,
  0x6ABC, 0x75BC, 0x89BC, 0x96BC, 0x4FBF, 0x50BF, 0xACBF, 0xB3BF, //191
  0x66C0, 0x79C0, 0x85C0, 0x9AC0, 0x43C3, 0x5CC3, 0xA0C3, 0xBFC3,
  0x2CC5, 0x33C5, 0xCFC5, 0xD0C5, 0x09C6, 0x16C6, 0xEAC6, 0xF5C6,
  0x84D0, 0x85DF, 0x8AD3, 0x8BDC, 0xB6D5, 0xB7DA, 0xB8D6, 0xB9D9,
  0xD0DA, 0xD1D5, 0xDED9, 0xDFD6, 0xE2DF, 0xE3D0, 0xECDC, 0xEDD3, //223
  0x2DE8, 0x32E8, 0xCEE8, 0xD1E8, 0x08EB, 0x17EB, 0xEBEB, 0xF4EB,
  0x67ED, 0x78ED, 0x84ED, 0x9BED, 0x42EE, 0x5DEE, 0xA1EE, 0xBEEE,
  0x0BF0, 0x14F0, 0xE8F0, 0xF7F0, 0x2EF3, 0x31F3, 0xCDF3, 0xD2F3,
  0x41F5, 0x5EF5, 0xA2F5, 0xBDF5, 0x64F6, 0x7BF6, 0x87F6, 0x98F6 //255
};


if ( (state->currentslot == 0 && state->K > 0 && state->dmr_so & 0x40 && state->payload_keyid == 0 && state->dmr_fid == 0x10) ||
      (state->currentslot == 0 && state->K > 0 && state->M == 1) )
{
  fprintf (stderr, "%s", KYEL);
  fprintf(stderr, " PrK %lld", state->K);
  fprintf (stderr, "%s", KNRM);
  k = Pr[state->K];
  k = ( ((k & 0xFF0F) << 32 ) + (k << 16) + k );

  for(Frame = 0; Frame < 6; Frame++)
  {
   for(i = 0; i < 3; i++)
   {
     for(j = 0; j < 48; j++)
     {
      x = ( ((k << j) & 0x800000000000) >> 47 );
      TSVoiceSupFrameL->TimeSlotAmbeVoiceFrame[Frame].AmbeBit[i][j] ^= x;
     }
   }
  }
}

if ( (state->currentslot == 1 && state->K > 0 && state->dmr_soR & 0x40 && state->payload_keyidR == 0 && state->dmr_fidR == 0x10) ||
      (state->currentslot == 1 && state->K > 0 && state->M == 1) )
{
  fprintf (stderr, "%s", KYEL);
  fprintf(stderr, " PrK %lld", state->K);
  fprintf (stderr, "%s", KNRM);
  k = Pr[state->K];
  k = ( ((k & 0xFF0F) << 32 ) + (k << 16) + k );

  for(Frame = 0; Frame < 6; Frame++)
  {
   for(i = 0; i < 3; i++)
   {
     for(j = 0; j < 48; j++)
     {
      x = ( ((k << j) & 0x800000000000) >> 47 );
      TSVoiceSupFrameR->TimeSlotAmbeVoiceFrame[Frame].AmbeBit[i][j] ^= x;
     }
   }
  }
}

if ( (state->currentslot == 0 && state->K1 > 0 && state->dmr_so & 0x40 && state->payload_keyid == 0 && state->dmr_fid == 0x68) ||
      (state->currentslot == 0 && state->K1 > 0 && state->M == 1) )
{

	int pos = 0;

	unsigned long long int k1 = state->K1;
	unsigned long long int k2 = state->K2;
	unsigned long long int k3 = state->K3;
	unsigned long long int k4 = state->K4;

	fprintf (stderr, "\n");
	fprintf (stderr, "%s", KYEL);
	fprintf(stderr, " SPT %010llX", k1);

	int T_Key[256] = {0};
	int pN[882] = {0};

	int len = 0;

	if (k2 == 0)
	{
		len = 39;
		k1 = k1 << 24;
	}
	if (k2 != 0)
	{
		len = 127;
		fprintf(stderr, " %016llX", k2);
	}
	if (k4 != 0)
	{
		len = 255;
		fprintf(stderr, " %016llX", k3);
		fprintf(stderr, " %016llX", k4);
	}

	fprintf (stderr, "%s", KNRM);

	for (i = 0; i < 64; i++)
	{
		T_Key[i]     = ( ((k1 << i) & 0x8000000000000000) >> 63 );
		T_Key[i+64]  = ( ((k2 << i) & 0x8000000000000000) >> 63 );
		T_Key[i+128] = ( ((k3 << i) & 0x8000000000000000) >> 63 );
		T_Key[i+192] = ( ((k4 << i) & 0x8000000000000000) >> 63 );
	}

	for (i = 0; i < 882; i++)
	{
		pN[i] = T_Key[pos];
		pos++;
		if (pos > len)
		{
			pos = 0;
		}
	}

	pos = 0;
	for(Frame = 0; Frame < 6; Frame++)
  {
   for(i = 0; i < 3; i++)
   {
     for(j = 0; j < 49; j++)
     {
      TSVoiceSupFrameL->TimeSlotAmbeVoiceFrame[Frame].AmbeBit[i][j] ^= pN[pos];
			pos++;
		 }
   }

  }

}

if ( (state->currentslot == 1 && state->K1 > 0 && state->dmr_soR & 0x40 && state->payload_keyidR == 0 && state->dmr_fidR == 0x68) ||
      (state->currentslot == 1 && state->K1 > 0 && state->M == 1) )
{

	int pos = 0;

	unsigned long long int k1 = state->K1;
	unsigned long long int k2 = state->K2;
	unsigned long long int k3 = state->K3;
	unsigned long long int k4 = state->K4;

	fprintf (stderr, "\n");
	fprintf (stderr, "%s", KYEL);
	fprintf(stderr, " SPT %010llX", k1);

	int T_Key[256] = {0};
	int pN[882] = {0};

	int len = 0;

	if (k2 == 0)
	{
		len = 39;
		k1 = k1 << 24;
	}
	if (k2 != 0)
	{
		len = 127;
		fprintf(stderr, " %016llX", k2);
	}
	if (k4 != 0)
	{
		len = 255;
		fprintf(stderr, " %016llX", k3);
		fprintf(stderr, " %016llX", k4);
	}

	fprintf (stderr, "%s", KNRM);

	for (i = 0; i < 64; i++)
	{
		T_Key[i]     = ( ((k1 << i) & 0x8000000000000000) >> 63 );
		T_Key[i+64]  = ( ((k2 << i) & 0x8000000000000000) >> 63 );
		T_Key[i+128] = ( ((k3 << i) & 0x8000000000000000) >> 63 );
		T_Key[i+192] = ( ((k4 << i) & 0x8000000000000000) >> 63 );
	}

	for (i = 0; i < 882; i++)
	{
		pN[i] = T_Key[pos];
		pos++;
		if (pos > len)
		{
			pos = 0;
		}
	}

	pos = 0;
	for(Frame = 0; Frame < 6; Frame++)
  {
   for(i = 0; i < 3; i++)
   {
     for(j = 0; j < 49; j++)
     {
      TSVoiceSupFrameR->TimeSlotAmbeVoiceFrame[Frame].AmbeBit[i][j] ^= pN[pos];
			pos++;
		 }
   }

  }

}

if (state->currentslot == 0)
{

  for(Frame = 0; Frame < 6; Frame++) //6
  {
    /* 1 DMR frame contains 3 AMBE voice samples */
    for(i = 0; i < 3; i++)
    {
      errs  = (int*)&(TSVoiceSupFrameL->TimeSlotAmbeVoiceFrame[Frame].errs1[i]);
      errs2 = (int*)&(TSVoiceSupFrameL->TimeSlotAmbeVoiceFrame[Frame].errs2[i]);
      state->errs =  TSVoiceSupFrameL->TimeSlotAmbeVoiceFrame[Frame].errs1[i]; //correct placement
      state->errs2 = TSVoiceSupFrameL->TimeSlotAmbeVoiceFrame[Frame].errs2[i]; //correct placement

      mbe_processAmbe2450Dataf (state->audio_out_temp_buf, errs, errs2, state->err_str,
                                TSVoiceSupFrameL->TimeSlotAmbeVoiceFrame[Frame].AmbeBit[i],
                                state->cur_mp, state->prev_mp, state->prev_mp_enhanced, opts->uvquality);

      if (opts->payload == 1)
      {
        PrintAMBEData(opts, state, TSVoiceSupFrameL->TimeSlotAmbeVoiceFrame[Frame].AmbeBit[i]);
      }

      //quick enc toggle to determine whether or not to play enc traffic
      int enc_bit = 0;
      enc_bit = (state->dmr_so >> 6) & 0x1;
      if (enc_bit == 1)
      {
        state->dmr_encL = 1;
      }
      else state->dmr_encL = 0;

      if (state->K != 0 || state->K1 != 0)
			{
				state->dmr_encL = 0;
			}

      //quick test to determine whether or not to run the next few steps below
      if (state->dmr_encL == 0 || opts->dmr_mute_encL == 0)
      {
        if (opts->mbe_out_f != NULL)
        {
          saveAmbe2450Data (opts, state, TSVoiceSupFrameL->TimeSlotAmbeVoiceFrame[Frame].AmbeBit[i]);
        }

        state->debug_audio_errors += *errs2;

        processAudio(opts, state);

        if (opts->wav_out_f != NULL)
        {
          writeSynthesizedVoice (opts, state);
        }

        if (opts->audio_out == 1) //opts->audio_out == 1
        {
          playSynthesizedVoice (opts, state);
        }
      } //second bracket for the test enc condition
    } /* End for(i = 0; i < 3; i++) */
  } /* End for(Frame = 0; Frame < 6; Frame++) */
 } //End if Current Slot == 0

 if (state->currentslot == 1)
 {

   for(Frame = 0; Frame < 6; Frame++)
   {
     /* 1 DMR frame contains 3 AMBE voice samples */
     for(i = 0; i < 3; i++)
     {
       errs  = (int*)&(TSVoiceSupFrameR->TimeSlotAmbeVoiceFrame[Frame].errs1[i]);
       errs2 = (int*)&(TSVoiceSupFrameR->TimeSlotAmbeVoiceFrame[Frame].errs2[i]);
       state->errs =  TSVoiceSupFrameR->TimeSlotAmbeVoiceFrame[Frame].errs1[i]; //correct placement
       state->errs2 = TSVoiceSupFrameR->TimeSlotAmbeVoiceFrame[Frame].errs2[i]; //correct placement

       mbe_processAmbe2450Dataf (state->audio_out_temp_buf, errs, errs2, state->err_str,
                                 TSVoiceSupFrameR->TimeSlotAmbeVoiceFrame[Frame].AmbeBit[i],
                                 state->cur_mp, state->prev_mp, state->prev_mp_enhanced, opts->uvquality);


       if (opts->payload == 1)
       {
         PrintAMBEData(opts, state, TSVoiceSupFrameR->TimeSlotAmbeVoiceFrame[Frame].AmbeBit[i]);
       }

       //quick enc toggle to determine whether or not to play enc traffic
       int enc_bit = 0;
       enc_bit = (state->dmr_soR >> 6) & 0x1;
       if (enc_bit == 1)
       {
         state->dmr_encR = 1;
       }
       else state->dmr_encR = 0;

       if (state->K != 0 || state->K1 != 0)
 			 {
 				state->dmr_encR = 0;
 			 }

       //quick test to determine whether or not to run the next few steps below
       if (state->dmr_encR == 0 || opts->dmr_mute_encR == 0)
       {
         if (opts->mbe_out_f != NULL)
         {
           saveAmbe2450Data (opts, state, TSVoiceSupFrameR->TimeSlotAmbeVoiceFrame[Frame].AmbeBit[i]);
         }

         state->debug_audio_errors += *errs2;

         processAudio(opts, state);

         if (opts->wav_out_f != NULL)
         {
           writeSynthesizedVoice (opts, state);
         }

         if (opts->audio_out == 1)
         {
           playSynthesizedVoice (opts, state);
         }
       }
     } /* End for(i = 0; i < 3; i++) */
   } /* End for(Frame = 0; Frame < 6; Frame++) */
 } //End if Current Slot == 1


} /* End ProcessDMR */
/* End of file */