//-----------------------------------------------------------------------------
// Software that is described herein is for illustrative purposes only  
// which provides customers with programming information regarding the  
// products. This software is supplied "AS IS" without any warranties.  
// NXP Semiconductors assumes no responsibility or liability for the 
// use of the software, conveys no license or title under any patent, 
// copyright, or mask work right to the product. NXP Semiconductors 
// reserves the right to make changes in the software without 
// notification. NXP Semiconductors also make no representation or 
// warranty that such application will be suitable for the specified 
// use without further testing or modification. 
//-----------------------------------------------------------------------------

#include "LPC17xx.h"
#include "emac.h"
#include "flashcfg.h"
#include "../sbl_config.h"
#include "../isp/isp_iap.h"
#include "../timer/timer.h"
#include "../ethernet/mdio.h"
#include <string.h>

#if ETHERNET_DEBUG
  #include "..\Debug\uart.h"
#endif 

#define EtherHdrLen		14
#define IpHdrLen		20
#define HdrLen          42			/* Ethernet hdr + IP hdr + UDP hdr  */

#define FrameSize  	    (data_size+HdrLen)
#define PACKET_BUF_SIZE 120
#define CR				0x0D
#define LF				0x0A

#define true			1
#define	false			0

#define HTONS(n) ((((unsigned short)((n) & 0xff)) << 8) | (((n) & 0xff00) >> 8))

#define FRAMEr   ((struct ethernet_hdr *)&rxbuffer[0])
#define PACKETr  ((struct packet_hdr *)&rxbuffer[14])
#define PAYLOADr	((struct payload *)&rxbuffer[42])

#define FRAMEt   ((struct ethernet_hdr *)&txbuffer[0])
#define PACKETt  ((struct packet_hdr *)&txbuffer[14])
#define PAYLOADt	((struct payload *)&txbuffer[42])

const char sync[] 	=	"Synchronized";
const char Ok[] 	=   "OK";

char synchro;
char rxbuffer[PACKET_BUF_SIZE];
char txbuffer[PACKET_BUF_SIZE];
char MyMAC[6]; 
char HostMAC[6];
unsigned short DestPort;
unsigned short SrcPort;
unsigned short data_size=0;
int dev_175x;

//int problems = 0;

static unsigned short *rxptr;
static unsigned short *txptr;

struct ethernet_hdr {
  char destination[6];
  char source[6];
  unsigned short protocol;
};

struct packet_hdr {
  char fill1[2];
  unsigned short iplen;
  char fill2[6];
  unsigned short iphdrchksum;
  char srcipaddr[4];       
  char destipaddr[4];
  unsigned short srcport;		
  unsigned short destport;		
  unsigned short udplen;	       
  unsigned short udpchksum;		
};

struct payload{
  char data[1472];
};

unsigned long ethernet_timeout;

char MYMAC_6, MYMAC_5, MYMAC_4, MYMAC_3, MYMAC_2, MYMAC_1;

//*****************************************************// 
//  Private functions                                  //
//*****************************************************//

static void load_mac_from_flash(void)
{
	FLASH_CFG *fcfg = (FLASH_CFG *) FLASH_CFG_LOCATION;
	int i;
	uint16_t sum = 1;
	
	/* verify data is valid */
	for (i = 0; i < sizeof(FLASH_CFG); i++) {
		sum = (sum + ((uint8_t *)fcfg)[i]) % 256;
	}
	sum = (sum - fcfg->chksum) % 256;
	sum &= 0xff;
	
	if (sum == fcfg->chksum) {
		MYMAC_6 = fcfg->macaddr[0];
		MYMAC_5 = fcfg->macaddr[1];
		MYMAC_4 = fcfg->macaddr[2];
		MYMAC_3 = fcfg->macaddr[3];
		MYMAC_2 = fcfg->macaddr[4];
		MYMAC_1 = fcfg->macaddr[5];
	} else {
		/* default values */
		MYMAC_6 = 0x00;
		MYMAC_5 = 0x0c;
		MYMAC_4 = 0x6a;
		MYMAC_3 = 0x01;
		MYMAC_2 = 0x03;
		MYMAC_1 = 0x10;
	}
}

void write_PHY (int PhyReg, int Value) {
  unsigned int tout;

  /* if LPC175x then use software MIIM/MDIO */
  if (dev_175x == TRUE)
  {
    //mdio_write(PhyReg, Value);
  }
  /* use hardware MIIM/MDIO */
  else
  {
		LPC_EMAC->MCMD = 0;
    LPC_EMAC->MADR = (PHY_ADDRESS<<8) | PhyReg;
    LPC_EMAC->MWTD = Value;

    /* Wait utill operation completed */
    tout = 0;
    for (tout = 0; tout < MII_WR_TOUT; tout++) {
      if ((LPC_EMAC->MIND & MIND_BUSY) == 0) {
        break;
      }
    }
  }
}

unsigned short read_PHY (unsigned char PhyReg) {
  unsigned int tout;
  unsigned short Value;

  /* if LPC175x then use software MIIM/MDIO */
  if (dev_175x == TRUE)
  {
    //Value = mdio_read(PhyReg);
  }
  /* use hardware MIIM/MDIO */
  else
  {
    LPC_EMAC->MADR = (PHY_ADDRESS<<8) | PhyReg;
    LPC_EMAC->MCMD = MCMD_READ;

    /* Wait until operation completed */
    tout = 0;
    for (tout = 0; tout < MII_RD_TOUT; tout++) {
      if ((LPC_EMAC->MIND & MIND_BUSY) == 0) {
        break;
      }
    }
    LPC_EMAC->MCMD = 0;
    Value = LPC_EMAC->MRDD;
  }

  return Value;
}

unsigned short ReadFrame_EMAC(void)
{
  return (*rxptr++);
}

void CopyFromFrame_EMAC(void *Dest, unsigned short Size) {
  unsigned short * piDest;                       

  piDest = Dest;                                 
  while (Size > 1) {
    *piDest++ = ReadFrame_EMAC();
    Size -= 2;
  } 
  if (Size) {                                         
    *(unsigned char *)piDest = (char)ReadFrame_EMAC();
  }                                                   
}

int same_mac(char * mac1,char * mac2) {
  int i;
  
  for(i=0; i<6; i++) {
    if(mac1[i] != mac2[i])
	  return false;
  }
  return true;
}

int filter_pass(void) {

   if (!synchro)
     return true;

   if(! same_mac(FRAMEr->source,HostMAC)) {
#if ETHERNET_DEBUG
	 print("Frame from different MAC: Filtered out!\n");
#endif   	
     return false;
   }
   if(PACKETr->destport != DestPort) {
#if ETHERNET_DEBUG
	 print("Packet from different Destination Port: Filtered out!\n");
#endif 
     return false;
   }
   if(PACKETr->srcport != SrcPort) {
#if ETHERNET_DEBUG
	 print("Packet to different Source Port: Filtered out!\n");
#endif 
     return false;
   }
   return true;
}

void WriteFrame_EMAC(unsigned short Data)
{
  *txptr++ = Data;
}

void CopyToFrame_EMAC(void *Source, unsigned int Size)
{
  unsigned short * piSource;

  piSource = Source;
  Size = (Size + 1) & 0xFFFE;    
  while (Size > 0) {
    WriteFrame_EMAC(*piSource++);
    Size -= 2;
  }
}

int chksum16(void *buf1, short len) {
  unsigned short * buf = buf1;
  int chksum16, chksum=0;

  while(len > 0) {	
    if (len == 1)
      chksum16 = ((*buf)&0x00FF);
    else
      chksum16 = (*buf);
    chksum = chksum + HTONS(chksum16);
    *buf++;
    len -=2;
  }
  return (~(chksum + ((chksum & 0xFFFF0000) >> 16))&0xFFFF);
}

//*****************************************************// 
//  Public functions                                   //
//*****************************************************//
void init_emac(void)  {
  unsigned int regv,tout,i;

  synchro = false;

#if LED_ENABLED
  /* configure activity LED pin as output */
  LPC_PINCON->PINSEL4 = 0;
  C41_LED_PORT->FIOPIN = 0;
  C41_LED_PORT->FIODIR |= (1<<C41_BLUE_LED_PIN);
  C41_LED_PORT->FIODIR |= (1<<C41_GREEN_LED_PIN);
  C41_LED_PORT->FIODIR |= (1<<C41_RED_LED_PIN);

  LINCOLN_LED_PORT->FIODIR |= (1<<LINCOLN_LED_PIN);

#endif

#if ETHERNET_DEBUG
  UART_init(115200);
  print("Ethernet Secondary Bootloader: Target in debug mode\n");
#endif 

  /* Power Up the EMAC controller. */
  LPC_SC->PCONP |= 0x40000000;

  /* configure ethernet pins */
  LPC_PINCON->PINSEL2 = 0x50150105;

  /* if device is an LPC175x then configure pins to use software */
  /* based MIIM/MDIO */
  if (is_LPC175x())
  {
    dev_175x = TRUE;
    /* use P2.8 for MDC and P2.9 for MDIO */
    LPC_PINCON->PINSEL4 &= ~0x000F0000;
    LPC_GPIO2->FIODIR |= MDC;
  }
  else
  {
    dev_175x = FALSE;
    /* configure pins for RMII and MIIM */
    LPC_PINCON->PINSEL3 = (LPC_PINCON->PINSEL3 & ~0x0000000F) | 0x00000005;
  }
  
  /* Reset all EMAC internal modules. */
  LPC_EMAC->MAC1    = MAC1_RES_TX | MAC1_RES_MCS_TX | MAC1_RES_RX | MAC1_RES_MCS_RX |
                      MAC1_SIM_RES | MAC1_SOFT_RES;
  LPC_EMAC->Command = CR_REG_RES | CR_TX_RES | CR_RX_RES;

  /* A short delay after reset. */
  for (tout = 100; tout; tout--);

  /* Initialize MAC control registers. */
  LPC_EMAC->MAC1 = MAC1_PASS_ALL;
  LPC_EMAC->MAC2 = MAC2_CRC_EN | MAC2_PAD_EN;
  LPC_EMAC->MAXF = ETH_MAX_FLEN;
  LPC_EMAC->CLRT = CLRT_DEF;
  LPC_EMAC->IPGR = IPGR_DEF;

  /* Enable Reduced MII interface. */
  LPC_EMAC->Command = CR_RMII | CR_PASS_RUNT_FRM;

  /* MII Mgmt Configuration register and MII Mgnt hardware Reset       */
  /* host clock divided by 20, no suppress preamble, no scan increment */
  LPC_EMAC->MCFG = HOST_CLK_BY_28 | MCFG_RES_MII;	
  for ( i = 0; i < 0x40; i++ );
  LPC_EMAC->MCFG &= (~MCFG_RES_MII);	/* Clear the reset */
  LPC_EMAC->MCMD = 0;	

  /* Put the PHY chip in reset mode */
  write_PHY (PHY_REG_BMCR, PHY_RESET);

  /* Wait for hardware reset to end. */
  for (tout = 0; tout < 0x100000; tout++) {
    regv = read_PHY (PHY_REG_BMCR);
    if (!(regv & PHY_RESET)) {
      /* Reset complete */
      break;
    }
  }

  /* this works for both the LAN8720 and KSZ8041 PHYs */
  write_PHY (PHY_REG_BMCR, PHY_RESTART_ANEG | PHY_EN_ANEG);

  /* Wait to complete Auto_Negotiation. */
  for (tout = 0; tout < 0x100000; tout++) {
    regv = read_PHY (PHY_REG_BMSR);
    if (regv & (PHY_LINK_UP)) {
      /* Autonegotiation Complete. Link is up. */
      break;
    }
  }
	
  /* Get the link params. */
  regv = read_PHY (PHY_REG_STS);

#if ETHERNET_DEBUG
  print("PHY status: ");
  printhexa(regv);
  print("\n------------------\n");
#endif
  
  /* Configure Full/Half Duplex mode. */
  if (regv & PHY_DPLX) {
    /* Full duplex is enabled. */
    LPC_EMAC->MAC2    |= MAC2_FULL_DUP;
    LPC_EMAC->Command |= CR_FULL_DUP;
    LPC_EMAC->IPGT     = IPGT_FULL_DUP;
  }
  else {
    /* Half duplex mode. */
    LPC_EMAC->IPGT = IPGT_HALF_DUP;
  }

  /* Configure 100MBit/10MBit mode. */
  if (regv & PHY_LINK_SPD) {
    /* 100MBit mode. */
    LPC_EMAC->SUPP = SUPP_SPEED;
  }
  else {
    /* 10MBit mode. */
    LPC_EMAC->SUPP = 0;
  }

  load_mac_from_flash();
  
  /* Set the Ethernet MAC Address registers */
  LPC_EMAC->SA0 = (MYMAC_1 << 8) | MYMAC_2;
  LPC_EMAC->SA1 = (MYMAC_3 << 8) | MYMAC_4;
  LPC_EMAC->SA2 = (MYMAC_5 << 8) | MYMAC_6;

  /* save the Ethernet MAC Address to MyMAC[] */
  MyMAC[0] = MYMAC_6;
  MyMAC[1] = MYMAC_5;
  MyMAC[2] = MYMAC_4;
  MyMAC[3] = MYMAC_3;
  MyMAC[4] = MYMAC_2;
  MyMAC[5] = MYMAC_1;

  /* Initialize Rx DMA Descriptors */
  for (i = 0; i < NUM_RX_FRAG; i++) {
    RX_DESC_PACKET(i)  = RX_BUF(i);
    RX_DESC_CTRL(i)    = RCTRL_INT | (ETH_FRAG_SIZE-1);
    RX_STAT_INFO(i)    = 0;
    RX_STAT_HASHCRC(i) = 0;
  }
  /* Set EMAC Receive Descriptor Registers. */
  LPC_EMAC->RxDescriptor       = RX_DESC_BASE;
  LPC_EMAC->RxStatus           = RX_STAT_BASE;
  LPC_EMAC->RxDescriptorNumber = NUM_RX_FRAG-1;
  /* Rx Descriptors Point to 0 */
  LPC_EMAC->RxConsumeIndex  = 0;

  /* Initialize Tx DMA Descriptors */
  for (i = 0; i < NUM_TX_FRAG; i++) {
    TX_DESC_PACKET(i) = TX_BUF(i);
    TX_DESC_CTRL(i)   = 0;
    TX_STAT_INFO(i)   = 0;
  }
  /* Set EMAC Transmit Descriptor Registers. */
  LPC_EMAC->TxDescriptor       = TX_DESC_BASE;
  LPC_EMAC->TxStatus           = TX_STAT_BASE;
  LPC_EMAC->TxDescriptorNumber = NUM_TX_FRAG-1;
  /* Tx Descriptors Point to 0 */
  LPC_EMAC->TxProduceIndex  = 0;

  /* Receive Broadcast and Perfect Match Packets */
  LPC_EMAC->RxFilterCtrl = RFC_PERFECT_EN;  

  /* Enable EMAC interrupts. */
  LPC_EMAC->IntEnable = INT_RX_DONE | INT_TX_DONE;

  /* Reset all interrupts */
  LPC_EMAC->IntClear  = 0xFFFF;

  /* Enable receive and transmit mode of MAC Ethernet core */
  LPC_EMAC->Command  |= (CR_RX_EN | CR_TX_EN);
  LPC_EMAC->MAC1     |= MAC1_REC_EN;

  /* Complete some IP & UDP header values */
  txbuffer[12] = 0x08;
  txbuffer[13] = 0x00;
  txbuffer[14] = 0x45;
  txbuffer[15] = 0x00;
  txbuffer[18] = 0xD8;
  txbuffer[19] = 0xF4;
  txbuffer[20] = 0x00;
  txbuffer[21] = 0x00;
  txbuffer[22] = 0x80;
  txbuffer[23] = 0x11;
}

// gets a command from the next packet received
// returns 0 if packet received, 1 if timeout
unsigned emac_getline(char * buf,int max_len,int * count) {
  unsigned short RxLen = 0;
  unsigned int idx, i;

#if ETHERNET_DEBUG
  int j;
#endif

#if LED_ENABLED
  int k=0;
#endif
 
  /* get timestamp for end of timeout period */
  ethernet_timeout = Timer_GetTimestamp() + ETHERNET_TIMEOUT;

  /* Check for Received frames */
  while(1){
    while(LPC_EMAC->RxConsumeIndex == LPC_EMAC->RxProduceIndex){
#if LED_ENABLED
    // FIXME
    /* increment the counter and check timeout  */
	  if (k++ > 200000) {
	     k=0;
		   /* toogle the LED           */
	     if (LINCOLN_LED_PORT->FIOPIN & (1<<LINCOLN_LED_PIN)) {
	       LINCOLN_LED_PORT->FIOCLR |= (1<<LINCOLN_LED_PIN);
	       C41_LED_PORT->FIOCLR |= (1<<C41_BLUE_LED_PIN);
		 } else {
	       LINCOLN_LED_PORT->FIOSET |= (1<<LINCOLN_LED_PIN);
	       C41_LED_PORT->FIOSET |= (1<<C41_BLUE_LED_PIN);
		 }
	  }
#endif

	  /* no filtered packets received during timeout period */
      if (Timer_HasTimestampExpired(ethernet_timeout))
	  {
#if ETHERNET_DEBUG
        print("Timed out - going back to looking for handshake\n");
#endif
	    return 1;
	  }
    }

    idx = LPC_EMAC->RxConsumeIndex;

    /* check for crc error */
	if (RX_STAT_INFO(idx) & RINFO_CRC_ERR)
	{
#if ETHERNET_DEBUG
      print("Rx CRC error\n");
#endif
      /* ignore frame */
      if (++idx == NUM_RX_FRAG)
  	  idx = 0;   
	    LPC_EMAC->RxConsumeIndex = idx;
      continue;
	}

    /* Get the Length and a pointer to the data  */
	RxLen = (RX_STAT_INFO(idx) & RINFO_SIZE) - 3;
    rxptr = (unsigned short *)RX_DESC_PACKET(idx);
    CopyFromFrame_EMAC(rxbuffer, RxLen);
    if (++idx == NUM_RX_FRAG)
	  idx = 0;
	  LPC_EMAC->RxConsumeIndex = idx;
    if(filter_pass())
      break;
  } 
  /* limit incoming data for protection  */
  
  if ((RxLen-42) > max_len)
    RxLen = max_len + 42;
  memcpy(buf,PAYLOADr->data,RxLen-42);

  /* detect '0x0A' (string terminator) and replace it by CR+LF  */
  for(i=0;i<max_len;i++) {
    if(buf[i]==CR){
      buf[i]='\0';
	  break;
	}
  }
  (*count) = i;

#if ETHERNET_DEBUG
  /* print received command   */
  print("Rx:  ");
  if (RxLen > 60) {
	print("...Data...");
  }else{
    j=0;
    for(i=0; i<(*count); i++) {
	  printascii(buf[i]);
      j++;
      if (j==16) {
        j=0;
        print("\r\n     ");
      }
    }
  }
  print("\r\n-------------------\r\n");
#endif

  // reset timestamp for end of timeout period
  ethernet_timeout = Timer_GetTimestamp() + ETHERNET_TIMEOUT;

  return (0);
}

unsigned emac_sendline_crlf(char * buf) {  
  int i;
  unsigned int idx;
	
#if ETHERNET_DEBUG
  int j;
#endif

  /* detect '\0' (string terminator) and replace it by CR+LF  */
  for(i=0;i<CMD_SIZE;i++) {
    PAYLOADt->data[i] = buf[i] ;			
    if(buf[i]=='\0'){
	  PAYLOADt->data[i]=CR;
	  PAYLOADt->data[i+1]=LF;
	  break;
	}
  }
  data_size = i+2;

#if ETHERNET_DEBUG
 
  print("Tx:  ");
  j=0;
  for(i=0; i<data_size-2; i++) {
	printascii(buf[i]);
    j++;
    if (j==16) {
      j=0;
      print("\r\n     ");
    }
  }
  print("\r\n-------------------\r\n");

#endif

  idx  = LPC_EMAC->TxProduceIndex;

  /* we're overrunning the TX descriptors, slow down a bit */
  while ((idx == NUM_TX_FRAG && LPC_EMAC->TxConsumeIndex == 0) ||
   LPC_EMAC->TxConsumeIndex == idx + 1) {
  }

  txptr = (unsigned short *)TX_DESC_PACKET(idx);
  TX_DESC_CTRL(idx) = FrameSize | TCTRL_LAST | TCTRL_INT;
  memcpy(FRAMEt->destination,FRAMEr->source,6);
  memcpy(FRAMEt->source,MyMAC,6);
  PACKETt->iplen = HTONS(FrameSize - EtherHdrLen);
  memcpy(PACKETt->destipaddr,PACKETr->srcipaddr,4);
  memcpy(PACKETt->srcipaddr,PACKETr->destipaddr,4);
  PACKETt->iphdrchksum = 0;
  PACKETt->iphdrchksum = HTONS(chksum16(PACKETt->fill1, IpHdrLen));
  PACKETt->destport = PACKETr->srcport;
  PACKETt->srcport = PACKETr->destport;
  PACKETt->udplen = HTONS(FrameSize - EtherHdrLen - IpHdrLen);
  PACKETt->udpchksum = 0;
  CopyToFrame_EMAC(&txbuffer[0], FrameSize);
  if (++idx == NUM_TX_FRAG) idx = 0;
  LPC_EMAC->TxProduceIndex = idx;
  //for (i = 0; i < 1000; i++);
  return (1);
}

int emac_handshake(int contact_made) {

   int count;
   char buf[15];
   char buf1[15];

   synchro = false;

   while(1) {
     if (contact_made || emac_getline(buf,1,&count) == 0) {
       if (contact_made || buf[0] == '?') {
		 contact_made = 0;
  	     /* save Dest & Source Ports   */
 	     DestPort = PACKETr->destport;
	     SrcPort  = PACKETr->srcport;

#if ETHERNET_DEBUG
         /* print Dest & Source Ports   */
	     print("Dest: ");
	     printhexa((DestPort>>8)&0xFF);
	     printhexa(DestPort&0xFF);
	     print("\nSource: ");
	     printhexa((SrcPort>>8)&0xFF);
	     printhexa(SrcPort&0xFF);
	     print("\n");
#endif
         /* save Host MAC address   */
	     memcpy(HostMAC,FRAMEr->source,6);

#if ETHERNET_DEBUG
         /* print Host MAC address  */
	     print("\nSource MAC: ");
	     printhexa(HostMAC[5]);
	     printhexa(HostMAC[4]);
	     printhexa(HostMAC[3]);
	     printhexa(HostMAC[2]);
	     printhexa(HostMAC[1]);
	     printhexa(HostMAC[0]);
	     print("\n");
#endif

         emac_sendline_crlf((char *)&sync[0]);         
         emac_getline(buf,15,&count);
	     memcpy(&buf1[0],&sync[0],sizeof(sync));
	     if (str_cmp(&buf[0],&buf1[0])==0) {
           emac_sendline_crlf((char *)&Ok[0]);
		   synchro = true;
		   break;
	     } else {
			 return (1);
		 }
       }
	 }
   }
   return (0);
}