/* Temperature logger based on PIC18F4550 via ethernet using */
/* Spartan 3E board.
/* Copyright I.Tsurin Liverpool University V1.0 (30.11.2011) */
/*                                                           */
/* Acknowledgment: Paulo Pedreiras, Out.2005 RCAI 05/06      */
/* http://www.ieeta.pt/~pedreiras/resources/rcai/raw-sr.c    */

/* Includes */
#include <stdio.h>
#include <stdlib.h>
#include <unistd.h>
#include <math.h>
#include <string.h>
#include <sys/time.h>
#include <ctype.h>

#include <signal.h>
#include <sys/ioctl.h>

#include <sys/socket.h>
#include <netinet/in.h>

#include <linux/if.h>
#include <netpacket/packet.h>
#include <net/ethernet.h>  // the L2 protocols
#include <asm/types.h>


#define ETH_SAFE_LEN (ETH_DATA_LEN - 100)
#define DEVICE "eth0"

int s = 0;		  // Socket descriptor
unsigned char *eth_head;  // byte pointer to ethenet header
unsigned char *eth_data;  // byte pointer to ethernet data field
struct ethhdr *eh;	  // structured pointer to ethernet header

struct sockaddr_ll socket_address;
void *buffer = NULL;

/* Local host NIC MAC address */
unsigned char   src_mac[6] = {0x00, 0x1D, 0x09, 0xB1, 0x46, 0x6F};

/* Front end address template */
unsigned char dest_mac[6] = {0x02, 0x00, 0x00, 0x00, 0x00, 0x00};

void sigint(int signum);
int eth_raw_init();

unsigned char l=1;
unsigned char O=0;

unsigned ePackID;
unsigned eCommID;

#define MCA   0
#define LU    2

#define MC    l
#define MB    O

#define Reset 0
#define Write 1
#define Read  2

#define Nt 13


/***************************************/
/*       Ethernet packet sender        */
/***************************************/

void PING(int Device, int Address, int Command, int Dsize)
{
  int i;

  ePackID = (rand()&0x7fff) | ((rand()&0x7fff)<<15);

/* Re-build ethernet header */

  dest_mac[0] =  (   MCA<<4 | Device<<3 | LU)&0xFF;
  dest_mac[1] = (Address<<4 | Command)&0xFF;
  dest_mac[2] = (ePackID>>24)&0xFF;
  dest_mac[3] = (ePackID>>16)&0xFF;
  dest_mac[4] = (ePackID>>8)&0xFF;
  dest_mac[5] = (ePackID>>0)&0xFF;

  eCommID = dest_mac[0]<<8 | (dest_mac[1]&0xF3);

  memcpy((void *)eh->h_dest,  (void*)dest_mac, ETH_ALEN);
  memcpy((void *)eh->h_source,(void*)src_mac,  ETH_ALEN);

/* Update data size */

  eh->h_proto = htons(Dsize);

/* Output data string */

  i = sendto(s, buffer, (Dsize + ETHER_HDR_LEN), 0,
               ((struct sockaddr*)&socket_address), sizeof(socket_address));

  if (i == -1) { perror("sendto():"); exit(1); }
}


/***************************************/
/*       Ethernet packet receiver      */
/***************************************/

int PONG(int Dsize)
{
  int i;
  int TimeOut = 100;

  while(TimeOut)
    {
      unsigned CommID;
      unsigned PackID;

/* Read NC buffer */

      i = recvfrom(s, buffer, ETHER_MAX_LEN, 0, NULL, NULL); // Dsize (?)

      if (i == -1) { perror("recfrom():"); exit(1); }

      CommID = eh->h_source[0]<<8  | (eh->h_source[1]&0xF3);
      PackID = eh->h_source[2]<<24 |  eh->h_source[3]<<16 | eh->h_source[4]<<8 | eh->h_source[5];

      if ((CommID == eCommID)&&(PackID == ePackID)) break; 

      TimeOut--;

    } /* end while(TimeOut) */

  return TimeOut;
}


/***************************************/
/*             main module             */
/*                                     */
/* send configuration to motherboard N */ 
/***************************************/

int main(int argc, char **argv)
{
  int ind;

/* Create socket */
  eth_raw_init();
  buffer = (void*)malloc(ETHER_MAX_LEN);

/* set structurised pointer to beginning of ethernet header */
  eth_head = buffer;  
  eh = (struct ethhdr *)eth_head;

/* set pointer to beginning of the ethernet data field */

   eth_data = buffer + ETH_HLEN;

while(1)
//for (ind=0; ind<100; ind++)
{
  int i;

  unsigned char *Wpt;
  int  Tmp[Nt];
  int Temp[Nt];

  for (i=0; i<Nt; i++)  Tmp[i]=0;
  for (i=0; i<Nt; i++) Temp[i]=0;

/* Request MC read */

  PING(MC, 0, Read, 38);

/* pause between send and receive ethernet packets
  (hardware needs 10us to receive and to retransmit) */

  usleep(20);

/* Extract temperatures */

  if (PONG(38))
     {
       Wpt = &eth_data[12];

       for (i=0; i<Nt; i++)
          {
            int ADRESH;
            int ADRESL;
            int ADRESM;

            ADRESH = (int)*Wpt++;
            ADRESL = (int)*Wpt++;

            ADRESM = (ADRESH & 0x1C)<<3;
            ADRESH = (ADRESH & 0x03)<<8;

            Tmp[i] = ADRESH | ADRESM | ADRESL;

          } /* end for(Nt) */

/* Mapping temperature channels and pedestal subtraction */

       Temp[0]  = Tmp[7]  - Tmp[2];
       Temp[1]  = Tmp[6]  - Tmp[2];
       Temp[2]  = Tmp[5]  - Tmp[2];
       Temp[3]  = Tmp[4]  - Tmp[2];
       Temp[4]  = Tmp[3]  - Tmp[2];
       Temp[5]  = Tmp[1]  - Tmp[2];
       Temp[6]  = Tmp[0]  - Tmp[2];
       Temp[7]  = Tmp[11] - Tmp[2];
       Temp[8]  = Tmp[9]  - Tmp[2];
       Temp[9]  = Tmp[8]  - Tmp[2];
       Temp[10] = Tmp[10] - Tmp[2];
       Temp[11] = Tmp[12] - Tmp[2];
       Temp[12] = Tmp[2];

       printf("%8.3f\n", ((float)Temp[0]-127.94)/(-5.94));

       sleep(1);

    } /* end if(PONG) */
} /* end for(ind) */

  return 0;

} /* end main */



/***************************************/
/*            eth_raw_init             */
/***************************************/

int eth_raw_init()
{
  int i;
  struct ifreq ifr;
  int ifindex = 0;  // Ethernet Interface index
  
/* Open socket */

  s = socket(PF_PACKET, SOCK_RAW, htons(ETH_P_ALL));
  if (s == -1) { perror("socket():"); exit(1); }

  printf("Successfully opened socket: %i\n", s);
  
/*Get ethernet interface index */

  strncpy(ifr.ifr_name, DEVICE, IFNAMSIZ);
  if (ioctl(s, SIOCGIFINDEX, &ifr) == -1) { perror("SIOCGIFINDEX"); exit(1); }

  ifindex = ifr.ifr_ifindex;
  printf("Successfully got interface index: %i\n", ifindex);
  
/* retrieve corresponding MAC */

  if (ioctl(s, SIOCGIFHWADDR, &ifr) == -1) { perror("SIOCGIFINDEX"); exit(1); }

  for (i=0; i<6; i++) src_mac[i] = ifr.ifr_hwaddr.sa_data[i];

  printf("Host MAC address: ");
  for (i=0; i<6; i++) printf("%02X:", src_mac[i]);
  printf("\n");
  
/* prepare sockaddr_ll */

  socket_address.sll_family   = PF_PACKET;
  socket_address.sll_protocol = 0x00;
  socket_address.sll_ifindex  = ifindex;
  socket_address.sll_pkttype  = PACKET_BROADCAST;
  socket_address.sll_halen    = ETH_ALEN;
  socket_address.sll_addr[0]  = dest_mac[0];
  socket_address.sll_addr[1]  = dest_mac[1];
  socket_address.sll_addr[2]  = dest_mac[2];
  socket_address.sll_addr[3]  = dest_mac[3];
  socket_address.sll_addr[4]  = dest_mac[4];
  socket_address.sll_addr[5]  = dest_mac[5];
  socket_address.sll_addr[6]  = 0x00; 
  socket_address.sll_addr[7]  = 0x00;
														
  
/* establish signal handler */

  signal(SIGINT, sigint);
  printf("Established signal handler for SIGINT\n");
  
  return 0;
}

/***************************************/
/*          Socket Terminator          */
/***************************************/

void sigint(int signum)
{
  struct ifreq ifr;
	
  if (s == -1) return; // No socket has beeen created
	
  strncpy(ifr.ifr_name, DEVICE, IFNAMSIZ);
  ioctl(s, SIOCGIFFLAGS, &ifr);
  ifr.ifr_flags &= ~IFF_PROMISC;
  ioctl(s, SIOCSIFFLAGS, &ifr);
  close(s);

  free(buffer);
	
  printf("Client terminating...\n");
  exit(0);
}