Subversion Repositories f9daq

#include "sender.h"

#define binary(bit) strtol(bit,NULL,2)

void SenderInit(){};

void SenderClose(){};

//------------------------------------------------------------------------------------------------------

// Send 1 data & address by UDP                                                                                                                                                  

void Senderudp_send( unsigned int address, int data){// data: send only 1 data length

  SiTCPRBCPskeleton(0xff, 0x80, address, 0x1, address);

  SiTCPsndData[0] = data;

  memcpy(SiTCPsndBuf+sizeof(struct bcp_header), SiTCPsndData, sizeof SiTCPsndData);

  int len = 0;

  len = sendto(SiTCPGetUDPSock(), SiTCPsndBuf, 1 + sizeof(struct bcp_header), 0,

               (struct sockaddr *)&SiTCPudpAddr, sizeof(SiTCPudpAddr));//important!

  if(len < 0){

    perror("UDP send error");

    printf("exit(1);!!!\n");

}

   SiTCPrcvRBCP_ACK(1);

}

//------------------------------------------------------------------------------------------------------  

// Recv 1 data & address by UDP

int Senderudp_recv( unsigned int address, int data){// data: send only 1 data length

    SiTCPRBCPskeleton(0xff, 0xc0, address, 0x1, address);

  int len = 0;

  len = sendto(SiTCPGetUDPSock(), SiTCPsndBuf, 1 + sizeof(struct bcp_header), 0,

               (struct sockaddr *)&SiTCPudpAddr, sizeof(SiTCPudpAddr));//important!

  if(len < 0){

    perror("UDP recv error");

    printf("exit(1);!!!\n");

  }

  int rd_data = 0;

  rd_data =  SiTCPrcvRBCP_ACK(1);

  // std::cout << rd_data << std::endl;

  return rd_data;

}

//------------------------------------------------------------------------------------------------------ 

// Send 1 packet data & address by UDP

void SenderRBCPpacket_send( unsigned int address,

                             unsigned char length, int* data){

  printf("enter packet function\n");

  SiTCPRBCPskeleton(0xff, 0x80, address, length, address);

  for(int i=0; i<256; ++i){

    SiTCPsndData[i] = data[i];// <- sndData: 0~255

  }

  memcpy(SiTCPsndBuf+sizeof(struct bcp_header), SiTCPsndData, sizeof SiTCPsndData);

  int len = 0;

  len = sendto(SiTCPGetUDPSock(), SiTCPsndBuf, sizeof SiTCPsndData + sizeof(struct bcp_header), 0,

               (struct sockaddr *)&SiTCPudpAddr, sizeof(SiTCPudpAddr));//important!

  if(len < 0){

    perror("UDP send error");

    printf("exit(1);!!!\n");

  }

  SiTCPrcvRBCP_ACK(0);

}

//------------------------------------------------------------------------------------------------------ 

// Recv 1 packet data & address by UDP

void SenderRBCPpacket_recv( unsigned int address,

                             unsigned char length, int* data){

  printf("enter packet function\n");

  SiTCPRBCPskeleton(0xff, 0xc0, address, length, address);

  int len = 0;

  len = sendto(SiTCPGetUDPSock(), SiTCPsndBuf, sizeof SiTCPsndData + sizeof(struct bcp_header), 0,

               (struct sockaddr *)&SiTCPudpAddr, sizeof(SiTCPudpAddr));//important!

  if(len < 0){

    perror("UDP recv error");

    printf("exit(1);!!!\n");

  }

  SiTCPrcvRBCP_ACK(1);

}

//------------------------------------------------------------------------------------------------------   

//=============== multi packet sending method ===============

void SenderRBCP_multi_packet_send( unsigned int address,

                                    unsigned int total_length, int* data){

  unsigned int total_packet = ((total_length/255)+1)*2;

  unsigned int packetNo = 0;

  printf("------------------ RBCP : register access ------------------\n");    

  printf("\n");    

  printf("Start sending packet data");    

  for(packetNo=0; packetNo<total_packet; ++packetNo){

    //    SiTCPrcvRBCP_ACK(0);

    SiTCPRBCPskeleton(0xff, 0x80, address+(packetNo*255), 0xff, address+(packetNo*255));

    for(int i=0; i<255; ++i){

      SiTCPsndData[i] = data[i+(packetNo*255)];// <- sndData: 0~255

    }

    memcpy(SiTCPsndBuf+sizeof(struct bcp_header), SiTCPsndData, sizeof SiTCPsndData);

    int len = 0;

    len = sendto(SiTCPGetUDPSock(), SiTCPsndBuf, sizeof SiTCPsndData + sizeof(struct bcp_header), 0,

                 (struct sockaddr *)&SiTCPudpAddr, sizeof(SiTCPudpAddr));//important!

    if(len < 0){

      perror("Send DAQ Start Signal");

      printf("exit(1);!!!\n");

    }

    SiTCPrcvRBCP_ACK(0);

    //    std::cout << SiTCPrcvRBCP_ACK(1) << std::endl;

        printf(".");  

  }

  printf("Done!!!\n");

  printf("\n");

  printf("Number of sent packets = %d\n", packetNo);

  printf("\n");

}

//------------------------------------------------------------------------------------------------------          

//--------------------EASIROC MADC sender---------------------------

int Senderread_madc( int data){// data: send only 1 data length

 //Set ADC ch to FPGA reg

  SiTCPRBCPskeleton(0xff, 0x80, 0x00000012, 0x1, 0x00000012);

  SiTCPsndData[0] = data;

  memcpy(SiTCPsndBuf+sizeof(struct bcp_header), SiTCPsndData, sizeof SiTCPsndData);

  int len = 0;

  len = sendto(SiTCPGetUDPSock(), SiTCPsndBuf, 1 + sizeof(struct bcp_header), 0,

               (struct sockaddr *)&SiTCPudpAddr, sizeof(SiTCPudpAddr));//important!

  if(len < 0){

    perror("UDP Send error");

    printf("exit(1);!!!\n");

  }

  SiTCPrcvRBCP_ACK(1);

  SiTCPRBCPskeleton(0xff, 0x80, 0x0000001f, 0x1, 0x0000001f);

  SiTCPsndData[0] = 1;

  memcpy(SiTCPsndBuf+sizeof(struct bcp_header), SiTCPsndData, sizeof SiTCPsndData);

  len = 0;

  len = sendto(SiTCPGetUDPSock(), SiTCPsndBuf, 1 + sizeof(struct bcp_header), 0,

               (struct sockaddr *)&SiTCPudpAddr, sizeof(SiTCPudpAddr));//important!

  if(len < 0){

    perror("UDP Send error");

    printf("exit(1);!!!\n");

  }

  SiTCPrcvRBCP_ACK(1);

  //Sleep(20000);//wait ADC ch change

  Sleep(2000);//wait ADC ch change

  //start Read ADC

  SiTCPRBCPskeleton(0xff, 0x80, 0x00000012, 0x1, 0x00000012);

  SiTCPsndData[0] = 240;

  memcpy(SiTCPsndBuf+sizeof(struct bcp_header), SiTCPsndData, sizeof SiTCPsndData);

  len = 0;

  len = sendto(SiTCPGetUDPSock(), SiTCPsndBuf, 1 + sizeof(struct bcp_header), 0,

               (struct sockaddr *)&SiTCPudpAddr, sizeof(SiTCPudpAddr));//important!

  if(len < 0){

    perror("UDP Send error");

    printf("exit(1);!!!\n");

  }

  SiTCPrcvRBCP_ACK(1);

  SiTCPRBCPskeleton(0xff, 0x80, 0x0000001f, 0x1, 0x0000001f);

  SiTCPsndData[0] = 0;

  memcpy(SiTCPsndBuf+sizeof(struct bcp_header), SiTCPsndData, sizeof SiTCPsndData);

  len = 0;

  len = sendto(SiTCPGetUDPSock(), SiTCPsndBuf, 1 + sizeof(struct bcp_header), 0,

               (struct sockaddr *)&SiTCPudpAddr, sizeof(SiTCPudpAddr));//important!

  if(len < 0){

    perror("UDP Send error");

    printf("exit(1);!!!\n");

  }

  SiTCPrcvRBCP_ACK(1);

  //read data

  int rd_data = 0;

  int rd_data1 = 0;

  int rd_data2 = 0;

  SiTCPRBCPskeleton(0xff, 0xc0, 0x00000004, 0x1, 0x00000004);

  len = 0;

  len = sendto(SiTCPGetUDPSock(), SiTCPsndBuf, 1 + sizeof(struct bcp_header), 0,

               (struct sockaddr *)&SiTCPudpAddr, sizeof(SiTCPudpAddr));//important!

  if(len < 0){

    perror("UDP recv error");

    printf("exit(1);!!!\n");

  }

  rd_data1 =  SiTCPrcvRBCP_ACK(1);

  // std::cout << rd_data << std::endl;

  SiTCPRBCPskeleton(0xff, 0xc0, 0x00000005, 0x1, 0x00000005);

  len = 0;

  len = sendto(SiTCPGetUDPSock(), SiTCPsndBuf, 1 + sizeof(struct bcp_header), 0,

               (struct sockaddr *)&SiTCPudpAddr, sizeof(SiTCPudpAddr));//important!

  if(len < 0){

    perror("UDP recv error");

    printf("exit(1);!!!\n");

  }

  rd_data2 =  SiTCPrcvRBCP_ACK(1);

  // std::cout << rd_data << std::endl;

  rd_data = rd_data1*256 + rd_data2;

  return rd_data;

}

//------------------------------------------------------------------------------------------------------ 

void Senderclear_all(){

  unsigned char address;

  int data;

  //int nbyte;

  // Send register clear

  address = 0x00;

  data = 0x0;

  Senderudp_send(address, data);

  printf("Clear all registers in FPGA.\n");

}