LINUX 下通过UDP端口发送命令以及接收反馈的代码

#include <stdio.h>
#include <sys/types.h>          
#include <sys/socket.h>
#include <string.h>
#include <sys/socket.h>
#include <netinet/in.h>
#include <arpa/inet.h>
#include <unistd.h>
#include <stdlib.h>
 
static fd_set fds;  // for udp_rcv 
static int cmd_rcv_socket_fd ;
static int cmd_send_socket_fd;
static unsigned char  buff_2k[2048] ;
 
struct sockaddr_in DEVAddr; 
static 
int creat_send_socket(unsigned int dev_ip,unsigned short dev_port,unsigned int my_pc_ip){
	
	
	static int open = 0;
	if (open==1) return 1; open=1;
    
	cmd_send_socket_fd = socket(PF_INET, SOCK_DGRAM, 0);  
	memset(&DEVAddr, '\0', sizeof(DEVAddr));
	DEVAddr.sin_family = AF_INET;
    DEVAddr.sin_port = htons(dev_port);
    DEVAddr.sin_addr.s_addr = dev_ip ;//inet_addr("127.0.0.1"); 

}
static 
int do_udp_sent (unsigned char *buf,int size ){
	sendto(cmd_send_socket_fd, buf, size, 0, (struct sockaddr*)&DEVAddr, sizeof(DEVAddr));	
}
static 
int creat_rcv_svr(unsigned int my_pc_ip,unsigned short port ){
  int r;
  struct sockaddr_in si_me;  
  cmd_rcv_socket_fd = socket(AF_INET, SOCK_DGRAM, 0);
  memset(&si_me, '\0', sizeof(si_me));
  si_me.sin_family = AF_INET;
  si_me.sin_port = htons(port);
  si_me.sin_addr.s_addr =  my_pc_ip ;//inet_addr("192.168.3.164");
  r=bind(cmd_rcv_socket_fd, (struct sockaddr*)&si_me, sizeof(si_me)); 
  
  if (r<0) printf("can not creat a rcv svr\n");
  else printf("rcv svr ok \n");
  //addr_size = sizeof(si_other);
}
static 
int do_udp_rcv(unsigned char *buff  ){
	static char r_buf[2048] ;
	struct sockaddr_in  si_other;
	socklen_t addr_size;
	addr_size = sizeof(si_other);
	int r ;
	unsigned char * p  = ( buff == NULL  ) ? r_buf : buff ;
	r = recvfrom(cmd_rcv_socket_fd, p, 2048, 0, (struct sockaddr*)& si_other, &addr_size);	
	return r ;
}


static 
int is_rcv_ready(int s ,int us ){
	int ret ;
	struct timeval timeout = {s,us};
	static fd_set fds;  
	FD_ZERO(&fds); 	
	int fd = cmd_rcv_socket_fd ;
	FD_SET(fd, &fds);
	ret = select(fd+1,&fds,NULL,NULL,&timeout );//阻塞等待，直到集合中有活跃的描述符  
	if (ret<0) return 0;
	if(FD_ISSET(fd, &fds)==0) return 0;
	return 1 ;
}

static 
int try_udp_rcv(unsigned char *buff,int s,int us   ){
	static char r_buf[2048] ;
	struct sockaddr_in  si_other;
	socklen_t addr_size;
	addr_size = sizeof(si_other);
	int r ;
	r = is_rcv_ready(s,us);
	if (r == 0) return 0; 
	unsigned char * p  = ( buff == NULL  ) ? r_buf : buff ;
	r = recvfrom(cmd_rcv_socket_fd, p, 2048, 0, (struct sockaddr*)& si_other, &addr_size);	
	return r ;
}



int init_udp_cmd(unsigned int dev_ip,unsigned short dev_cmd_port,unsigned int my_pc_ip,unsigned short my_pc_rcv_port){

	static int open = 0;
	if (open==1) return 1;
	open=1;
	
    struct timeval timeout = {0,1};
		
	creat_send_socket( dev_ip,dev_cmd_port,my_pc_ip);
    creat_rcv_svr(my_pc_ip, my_pc_rcv_port ) ;
    
	while(1){	 if (is_rcv_ready(0,10)) do_udp_rcv(NULL);else break;	 }
     
} 

static int send_and_rcv_cmd(unsigned char * send_buff,int send_len,unsigned int *rcv_buff){ //rcv_buff at least is 2K
int  r  = 0 ;
do_udp_sent(send_buff,send_len);
r = try_udp_rcv( rcv_buff , 10,0) ;
//r = do_udp_rcv( rcv_buff ) ;
return r ; 
}

static void test_send (void){
	
	unsigned int dev_ip = inet_addr("192.168.234.1") ;
	unsigned int my_ip  = inet_addr("192.168.234.128") ;
	unsigned short dev_port = 8080 ;
	
	static char buff[10] ={"0123456789"};
	creat_send_socket( dev_ip,dev_port,my_ip);
	
	
	while(1){
		do_udp_sent(buff,10);
		sleep(3);
	}
	
	
}


static void test_rcv (void){
	 
	unsigned int my_ip  = inet_addr("192.168.234.128") ;
	unsigned short dev_port = 8080 ;
	 
	creat_rcv_svr( my_ip,47771);
	static char buff[2048]  = { 0 } ;
	int r;
	while(1){
	r = do_udp_rcv(buff);
	printf("r = %d\n",r);
	
	//	sleep(3);
	}
	
	
}

 


static unsigned char  str_buff[1024]  ; 
static char str[1024]                 ;
static char rcv_buff[2048]            ;

static int do_set_and_chk(char *str,  int  value){
sprintf(str,"%s=%u\r\n",str,(unsigned int )value);
int r = send_and_rcv_cmd(str,strlen(str),rcv_buff) ;
if (r <=0 ) return -1; // can not send nor rcv 
if (strfind(rcv_buff,str)==0) return -2 ; // not a ligal respone 
puts(rcv_buff);
return 1 ;   // good 
}



int set_sample_rate(int sample_rate_in_hz ){ 
strcpy(str_buff,"rx_samp_freq");
return do_set_and_chk(str_buff, sample_rate_in_hz);
}



/*


Available commands:
help?  - Displays all available commands.
register?  - Gets the specified register value.
tx_lo_freq?  - Gets current TX LO frequency [MHz].
tx_lo_freq=  - Sets the TX LO frequency [MHz].
tx_samp_freq?  - Gets current TX sampling frequency [Hz].
tx_samp_freq=  - Sets the TX sampling frequency [Hz].
tx_rf_bandwidth?  - Gets current TX RF bandwidth [Hz].
tx_rf_bandwidth=  - Sets the TX RF bandwidth [Hz].
tx1_attenuation?  - Gets current TX1 attenuation [mdB].
tx1_attenuation=  - Sets the TX1 attenuation [mdB].
tx2_attenuation?  - Gets current TX2 attenuation [mdB].
tx2_attenuation=  - Sets the TX2 attenuation [mdB].
tx_fir_en?  - Gets current TX FIR state.
tx_fir_en=  - Sets the TX FIR state.
rx_lo_freq?  - Gets current RX LO frequency [MHz].
rx_lo_freq=  - Sets the RX LO frequency [MHz].
rx_samp_freq?  - Gets current RX sampling frequency [Hz].
rx_samp_freq=  - Sets the RX sampling frequency [Hz].
rx_rf_bandwidth?  - Gets current RX RF bandwidth [Hz].
rx_rf_bandwidth=  - Sets the RX RF bandwidth [Hz].
rx1_gc_mode?  - Gets current RX1 GC mode.
rx1_gc_mode=  - Sets the RX1 GC mode.
rx2_gc_mode?  - Gets current RX2 GC mode.
rx2_gc_mode=  - Sets the RX2 GC mode.
rx1_rf_gain?  - Gets current RX1 RF gain.
rx1_rf_gain=  - Sets the RX1 RF gain.
rx2_rf_gain?  - Gets current RX2 RF gain.
rx2_rf_gain=  - Sets the RX2 RF gain.
rx_fir_en?  - Gets current RX FIR state.
rx_fir_en=  - Sets the RX FIR state.

*/


int set_tx_lo_freq(int tx_lo_freq_in_Mhz ){
strcpy(str_buff,"tx_lo_freq");
return do_set_and_chk(str_buff, tx_lo_freq_in_Mhz);
}


 
int set_rx_lo_freq(int rx_lo_freq_in_Mhz ){
strcpy(str_buff,"tx_lo_freq");
return do_set_and_chk(str_buff, rx_lo_freq_in_Mhz);
}

int set_tx1_attenuation(int tx1_attenuation){
strcpy(str_buff,"tx1_attenuation");
return do_set_and_chk(str_buff, tx1_attenuation);
 }

int set_tx2_attenuation(int tx2_attenuation){ 
strcpy(str_buff,"tx2_attenuation");
return do_set_and_chk(str_buff, tx2_attenuation);
}

int set_rx1_rf_gain(int rf_gain){
strcpy(str_buff,"rx1_rf_gain");
return do_set_and_chk(str_buff, rf_gain);
}

int set_rx2_rf_gain(int rf_gain){
strcpy(str_buff,"rx2_rf_gain");
return do_set_and_chk(str_buff, rf_gain);
}

int set_rx_rf_bandwidth(int rx_rf_bandwidth_in_hz){
strcpy(str_buff,"rx_rf_bandwidth");
return do_set_and_chk(str_buff, rx_rf_bandwidth_in_hz);
}

int set_tx_rf_bandwidth(int tx_rf_bandwidth_in_hz){
strcpy(str_buff,"tx_rf_bandwidth");
return do_set_and_chk(str_buff, tx_rf_bandwidth_in_hz);
}



/*

int init_udp_cmd(unsigned int dev_ip,unsigned short dev_cmd_port,unsigned int my_pc_ip,unsigned short my_pc_rcv_port) ;
int set_sample_rate(int   );
int set_tx_rf_bandwidth(int  );
int set_rx_rf_bandwidth(int  );
int set_rx2_rf_gain(int  );
int set_rx1_rf_gain(int  );
int set_tx2_attenuation(int  );
int set_tx2_attenuation(int  );
int set_tx_lo_freq(int   );
int set_rx_lo_freq(int   );

*/

 

调用的函数如下：

void main (){

unsigned int dev_ip = inet_addr("192.168.234.1");
unsigned short dev_cmd_port = 8080 ;
unsigned  int my_pc_ip = inet_addr("192.168.234.128") ; 
unsigned short my_rcv_port =  8090 ;
init_udp_cmd ( dev_ip,dev_cmd_port,my_pc_ip,my_rcv_port);
 
set_sample_rate(3*1000*1000);
 
return ;


}

另外用到了strfind这个函数，我自己写的，如下：

static int my_strncmp(char *a,char *b,int len ){

    int i ;

	for(i=0;i<len;++i)  if (a[i]!=b[i]) return 0;

    return 1 ;

}

    

    

int strfind(char *line,char *word){

    int r , i, word_len ,line_len ; r=0;

    word_len = strlen (word) ; 

    line_len = strlen (line) ; 

    for (i=0;i<line_len;++i)if ( my_strncmp(word,line+i,word_len) == 1 )  r = 1;

    return r ;

}

明天连接SDRPI进行命令调试。成功后立即转入STREAM的调试。