解决获取3G信号强度(转载)

本文主要是介绍解决获取3G信号强度(转载)，希望对大家解决编程问题提供一定的参考价值，需要的开发者们随着小编来一起学习吧！
http://blog.csdn.net/lwpping/article/details/7530760
获取强度：AT＋CSQ 以“\r","\n"结尾
遇到问题：
一方面是因为AT指令格式不对，最后只发了"\r",没有发"\n",另外 PPP与AT采用不同的tty,我的模块是BD_MF206（可以发AT＋CGMR得到），对应的ttyUSB1为AT指令，ttyUSB2为PPP对应的，但有点不明白的是一开始用的是ttyUSB2,而且指令也没有加"\n",居然一样得到了信号强度。。。;而且使用ttyUSB1发送命令。。时常返回ERROR。。
是因为串初始化没做好。
[cpp]  view plain copy  
 #include <stdio.h>          
 #include <stdlib.h>  
 #include <sys/types.h>  
 #include <sys/stat.h>    
 #include <fcntl.h>           
 #include <termios.h>       
 #include <errno.h>          
 #include <sys/ioctl.h>        
 #include <assert.h>           
 #include <pthread.h>  
   
 #include <sys/wait.h>  
 #include <sys/klog.h>  
 #include <syslog.h>  
 #include <string.h>  
   
   
 static int is_value_get(void);  
 static int write_level(char *level);  
   
   
 pthread_mutex_t read_mutex;  
 pthread_cond_t  read_cond;  
   
   
 pthread_mutex_t wr_mutex;  
 pthread_cond_t  wr_cond;  
 static wr_num_sig = 0;  
 static re_num_sig = 0;  
   
 static int m_fd;  
 static int get_level = -1;  
 static check_sec = 3 ;  
 static err_num = 0;  
 static int ok_flag = 0;  
 static int snum = 5;  
   
 //#define DEBUG  
   
 #ifdef DEBUG  
 #define debug(fmt,args...)   do { syslog(LOG_INFO,"%s: -->"fmt, __FUNCTION__,##args); } while (0)  
 #else  
 #define debug(fmt,args...)  while(0)  
 #endif  
   
 #define STORE_3G_LEVEL  "/sys/devices/platform/netconstore/store_3g"  
   
   
 //write level value to the sys interface  
 int write_level(char *level)  
 {  
   
     char cmd[200];        
     sprintf(cmd,"echo %s > /sys/devices/platform/netconstore/store_3g",level);  
     debug("LWP========= the cmd is %s\n",cmd);  
   
     int ret = system(cmd);  
     if (WEXITSTATUS (ret) == 0)  
     {  
         return 1;  
     }  
   
     debug("LWP=========HAS write %s into sys \n",level);  
   
     return 1;  
   
 }  
   
   
 #if 1  
 //send the at cmd to the 3G MODEM  
 int send_cmd(char *cmd)  
 {  
     debug("HAS INTO send_cmd!!!!!!!!!!!!!!!!!!!!!!!!!\n");  
   
     int n;  
     int m = 0;  
   
 rewrite:  
   
     n = write(m_fd, cmd, strlen(cmd));  
     if(n < 0)  
     {  
         fprintf(stderr,"write 3g device failed by:%s",strerror(errno));  
         //open ttyusb1  
         close(m_fd);  
         open_3g_dev_ttyusb1();    
         goto rewrite;  
         //return -1;  
     }  
   
     debug("WRITE AT+CSQ ok!!\n");  
   
   
   
 #if 1  
     n = write(m_fd, "\r",1);  
     if(n < 0)  
     {  
         fprintf(stderr,"write R device failed by:%s",strerror(errno));  
         return -1;  
     }  
   
 #endif  
   
 #if 1  
     n = write(m_fd, "\n",1);  
     if(n < 0)  
     {  
         fprintf(stderr,"write R device failed by:%s",strerror(errno));  
         return -1;  
     }  
     debug("WRITE \\r \\n ok!!\n");  
 #endif  
   
     usleep(300);  
   
     //send the signal to get_res  
     pthread_mutex_lock(&read_mutex);  
     if(re_num_sig > 0)  
     {  
         pthread_cond_signal(&read_cond);  
         pthread_mutex_unlock(&read_mutex);  
     }  
     else  
     {  
         pthread_mutex_unlock(&read_mutex);  
     }  
     //then wait the get_res deal the result   
     pthread_mutex_lock(&wr_mutex);  
       
     wr_num_sig++;  
     pthread_cond_wait(&wr_cond, &wr_mutex);  
     pthread_mutex_unlock(&wr_mutex);  
       
     return 1;  
 }  
 #endif  
   
   
 //get the at cmd result  
 void *get_res(void *para)  
 {  
       
     debug("lwp==========================HAS INTO GET RES\n!!!!!!!!!!!!!!!!!!!!!!!!!");  
     int n;  
     char res[512];  
     char *g_tmp = NULL;  
     char *g_token=NULL;  
       
       
 for(;;)  
 {  
     //wait the write func to send the sigal to begin read  
     pthread_mutex_lock(&read_mutex);  
     re_num_sig++;  
       
     pthread_cond_wait(&read_cond, &read_mutex);  
     pthread_mutex_unlock(&read_mutex);  
           
     memset(res,0,512);  
       
   
 #if 1         
     while(read(m_fd, res, 512))  
     {  
         debug("lwp==========================[[IN while]]HAS read %s \n",res);  
         if(strstr(res,"+CSQ:"))  
         {             
             g_tmp = res;  
             if((g_token = strsep (&g_tmp,":"))!=NULL)  
             {  
                 debug("g_token is %s \n",g_token);  
                 if((g_token = strsep (&g_tmp,","))!=NULL)  
                 {  
                     debug("g_token is %s \n",g_token);  
                       
                     write_level(g_token);  
                                           
                       
                     get_level = atoi(g_token);  
                     debug("after atoi g_token is %d\n",get_level);  
                       
                     //close(m_fd);  
                     //send signal to write func to get level again  
                     pthread_mutex_lock(&wr_mutex);  
                     if(wr_num_sig > 0)  
                     {  
                         pthread_cond_signal(&wr_cond);  
                         pthread_mutex_unlock(&wr_mutex);  
                     }  
                     else  
                     {  
                         pthread_mutex_unlock(&wr_mutex);  
                     }  
                     break;  
                 }  
             }  
             break;  
         }  
         else if(strstr(res,"ERROR"))  
         {  
     #if 0     
             close(m_fd);  
             open_3g_dev();  
       
             err_num++;  
               
             if(err_num == 16)  
             {  
                 check_sec = 60;  
             }  
     #endif  
       
             err_num++;  
             pthread_mutex_lock(&wr_mutex);  
                     if(wr_num_sig > 0)  
                     {  
                         pthread_cond_signal(&wr_cond);  
                         pthread_mutex_unlock(&wr_mutex);  
                     }  
                     else  
                     {  
                         pthread_mutex_unlock(&wr_mutex);  
                     }  
                       
                       
             break;  
         }  
         else if(strstr(res,"3GNET"))  
         {  
     #if 1     
             close(m_fd);  
             open_3g_dev_ttyusb1();  
     #endif    
               
             pthread_mutex_lock(&wr_mutex);  
                     if(wr_num_sig > 0)  
                     {  
                         pthread_cond_signal(&wr_cond);  
                         pthread_mutex_unlock(&wr_mutex);  
                     }  
                     else  
                     {  
                         pthread_mutex_unlock(&wr_mutex);  
                     }  
                       
                       
             break;  
         }  
         //debug("lwp==========================HAS read %s \n",res);  
     }  
       
 #endif  
   
     debug("lwp==========================after one read...\n");  
 }  
   
     debug("lwp==========================++++++++++exit the read at result pthread++\n");  
 }  
   
   
 //creat the get the at cmd results thread  
 int init_get_res()  
 {  
     int err;  
     pthread_t       rtid;     
     pthread_attr_t pthread_attr;  
   
     if(pthread_attr_init(&pthread_attr)){  
         syslog(LOG_ERR, "Attribute creation failed in %s", __FUNCTION__);  
         return -1;  
     }  
     if(pthread_attr_setdetachstate(&pthread_attr, PTHREAD_CREATE_DETACHED) ){  
         syslog(LOG_ERR,"Setting detach attribute failed in %s", __FUNCTION__);  
         return -1;  
     }  
   
     if((err = pthread_create(&rtid, &pthread_attr, get_res, NULL))) {  
         fprintf(stderr,"creat init_get_res failed:%s\n",strerror(errno));  
         return -1;  
     }  
   
     return 1;  
 }  
   
   
 int open_3g_dev()  
 {  
     debug("OPEN 3G DEVIECE ttyUSB2\n");  
   
     m_fd = open("/dev/ttyUSB2", O_RDWR | O_NOCTTY);  
     if(m_fd < 0)  
     {  
         fprintf(stderr,"open 3g device failed by:%s",strerror(errno));  
         return -1;  
     }     
   
     return 1;  
 }  
   
 int open_3g_dev_ttyusb1()  
 {  
     //open ttyUSB2 failed we try to open ttyUSB1  
     debug("OPEN 3G DEVIECE ttyUSB1\n");       
     m_fd = open("/dev/ttyUSB1", O_RDWR | O_NOCTTY);  
     if(m_fd < 0)  
     {  
         fprintf(stderr,"open 3g device failed by:%s\n",strerror(errno));  
         exit(-1);         
     }     
   
     return 1;  
   
 }  
   
 //judge if has get the 3g level at begin  
 int is_value_get()  
 {  
   
     FILE *g_fp;  
     int g_read = -1;  
     char g_buffer[BUFSIZ];  
   
     g_fp = popen("cat /sys/devices/platform/netconstore/store_3g", "r");  
     if ( g_fp != NULL )   
     {  
         g_read = fread(g_buffer, sizeof(char), BUFSIZ-1, g_fp);  
         if (g_read <= 0)   
         {                 
             pclose(g_fp);  
             return -1;  
         }  
         else  
         {  
             pclose(g_fp);  
             return 1;  
         }  
     }  
     else  
     {  
         return -1;  
     }  
 }  
   
 int is_3g_on()  
 {  
     debug("INTO the check modem!!!");  
     FILE *fp;  
     char line[1024];  
   
     syslog(LOG_INFO, "%s:--> begin to check ppp0", __FUNCTION__);  
     if( (fp=fopen("/proc/net/route", "r")) < 0) {  
         syslog(LOG_ERR, "/proc/net/route open failed");  
         return 0;  
     }  
   
     while(fgets(line, 1023, fp)) {  
         if(strstr(line, "ppp0")) {  
             debug("3G IS ON!!!");  
             fclose(fp);  
             return 1;  
         }  
     }  
   
     syslog(LOG_INFO, "%s:--> 3g is off", __FUNCTION__);  
     fclose(fp);  
     return 0;     
   
 }  
   
   
 void  init_log(void)  
 {  
     int option = LOG_NDELAY | LOG_PID | LOG_PERROR;  
     openlog("CONNDAEMON", option, LOG_DAEMON);  
     syslog(LOG_INFO, "connd started !");  
 }  
   
 static int open_dev(const char *dev)  
   
 {  
   
     int  fd = open( dev, O_RDWR | O_NOCTTY | O_NDELAY );  
   
     if (fd != -1 ){  
   
         fcntl(fd, F_SETFL,0); //set to block  
   
     }  
   
     return fd;  
   
 }  
   
   
 void close_serial_port(int fd)  
 {  
   
     close(fd);  
   
 }  
   
 int set_opt(int fd,int nSpeed, int nBits, char nEvent, int nStop)  
 {  
     struct termios newtio,oldtio;  
     //save old setting  
     if ( tcgetattr( fd,&oldtio) != 0)   
     {   
         perror("SetupSerial 1");  
         return -1;  
     }  
     //extern void bzero(void *s, int n); set s zero   
     bzero( &newtio, sizeof( newtio ) );  
     //set the size of char  
     newtio.c_cflag |= CLOCAL | CREAD;   
     newtio.c_cflag &= ~CSIZE;  
     //set data mode  
     switch( nBits )  
     {  
         case 7:  
             newtio.c_cflag |= CS7;  
             break;  
         case 8:  
             newtio.c_cflag |= CS8;  
             break;  
     }  
     //set check  
     switch( nEvent )  
     {  
         case 'O':  
             newtio.c_cflag |= PARENB;  
             newtio.c_cflag |= PARODD;  
             newtio.c_iflag |= (INPCK | ISTRIP);  
             break;  
         case 'E':   
             newtio.c_iflag |= (INPCK | ISTRIP);  
             newtio.c_cflag |= PARENB;  
             newtio.c_cflag &= ~PARODD;  
             break;  
         case 'N':   
             newtio.c_cflag &= ~PARENB;  
             break;  
     }  
     //set bound  
     switch( nSpeed )  
     {  
         case 2400:  
             cfsetispeed(&newtio, B2400);  
             cfsetospeed(&newtio, B2400);  
             break;  
         case 4800:  
             cfsetispeed(&newtio, B4800);  
             cfsetospeed(&newtio, B4800);  
             break;  
         case 9600:  
             cfsetispeed(&newtio, B9600);  
             cfsetospeed(&newtio, B9600);  
             break;  
         case 115200:  
             cfsetispeed(&newtio, B115200);  
             cfsetospeed(&newtio, B115200);  
             break;  
         default:  
             cfsetispeed(&newtio, B9600);  
             cfsetospeed(&newtio, B9600);  
             break;  
     }  
     //set stop  
     if( nStop == 1 )  
         newtio.c_cflag &= ~CSTOPB;  
     else if ( nStop == 2 )  
         newtio.c_cflag |= CSTOPB;  
     //set wait time and less recv char   
     newtio.c_cc[VTIME] = 0;  
     newtio.c_cc[VMIN] = 0;  
     //deal the char not recv  
     tcflush(fd,TCIFLUSH);  
     //new setting   
     if((tcsetattr(fd,TCSANOW,&newtio))!=0)  
     {  
         perror("com set error");//  
         return -1;  
     }  
     printf("set done!\n");  
     return 0;  
 }  
   
   
 int main(int argc, char *argv[])  
 {     
   
     init_log();  
   
 #if 1  
     /* we should change daemon(0,1) to daemon(0,0) after finish all */  
     if(daemon(1,1)<0){  
         fprintf(stderr,"connd can't init daemon!");  
         exit(-1);  
     }  
   
 #endif  
   
     if ((m_fd = open_dev("/dev/ttyUSB1")) < 0)  
     {  
         fprintf(stderr,"open 3g device failed \n");  
         return -1;  
     }  
   
     //set_opt(int fd,int nSpeed, int nBits, char nEvent, int nStop);  
   
     if(set_opt(m_fd,115200,8,'N',1) < 0)  
     {  
         fprintf(stderr,"set serial  failed \n");  
         return -1;  
     }  
   
     debug("set serial ok\n!!!!!!!!!!!!!!!!!!!!!!!!!!!!!");  
     //creat the get result thread   
     if(init_get_res() < 0 )  
     {  
         return -1;  
     }  
   
   
 #if 1  
     while(1)   
     {  
   
         if(send_cmd("AT+CSQ") < 0)  
         {  
             fprintf(stderr,"the send cmd to 3g wrong!!\n");  
             close(m_fd);  
             return -1;  
         }  
   
         if((is_value_get()) == 1)  
         {  
             check_sec = 40;  
             err_num = 0;  
   
         }         
         else  
         {  
             if(err_num > 10)  
             {  
                 check_sec = 120;  
             }  
             else  
             {  
                 check_sec = 2;  
             }  
         }     
   
         sleep(check_sec);         
     }  
 #endif  
   
     return 0;  
 }