【正文】 //privr_idx = (privr_idx + 1) % BUFSIZE。 PDF(2,buffer full\n)。 } privbuffer[privw_idx] = data。 //保證是環(huán)狀的FIFO。 } else //read data { if ((privr_idx == widx)) { PDF(2, buffer empty\n)。} else { temp= privbuffer[privr_idx]。 //保證是環(huán)狀的FIFO。 } } PDF(2, flag error\n)。}zh_gpsDriver::zh_gpsDriver(QObject * parent,const char * name):QObject(parent,name){ COM_PARAM mCOMParam。 =9600。 =0。 mpGPS_GPRMC=amp。 mpGPS_GPRMCgps_sw=39。 mpGPS_GPGSV=amp。 PDF(1,gps driver construct!\n)。 setCOM(mCOMParam)。 int idata。fifo,idata,RD)。} else if(idata==39。) { pcmd_bufbuf[pcmd_bufpos]=(char)(idataamp。 pcmd_bufpos++。 break。pcmd_bufpos++。 /// PDF(4,end of a line !\n)。CMDBUF_Init(pcmd_buf)。 pcmd_bufbuf[pcmd_bufpos]=39。 // PDF(4,pos=%d ibufpos=%d a msg=%s\n,pos,ibufpos,pStrBuffer)。}int zh_gpsDriver::zh_getGPSdata(GPS_DATA amp。 =mpGPS_GPRMClatitude。 return mpGPS_GPRMCgps_sw。 int fz。 fz=(int)fi。//取整數(shù)部分 ffx=fiffz。 PDF(2,ddmm=%lf dddd:%lf\n ,ddmm,fi )。 }int zh_gpsDriver::GPGSV_Analysis( GPS_GPGSV * pGPS_GPGSV){ switch(pGPS_GPGSVGSV_ID){ case 1:memcpy(amp。(pGPS_GPGSVSta1),sizeof(STA_INFO))。([1]),amp。 memcpy(amp。(pGPS_GPGSVSta3),sizeof(STA_INFO))。([3]),amp。 break。([4]),amp。 memcpy(amp。(pGPS_GPGSVSta2),sizeof(STA_INFO))。([6]),amp。 memcpy(amp。(pGPS_GPGSVSta4),sizeof(STA_INFO))。 case 3:memcpy(amp。(pGPS_GPGSVSta1),sizeof(STA_INFO))。([9]),amp。 memcpy(amp。(pGPS_GPGSVSta3),sizeof(STA_INFO))。([11]),amp。 break。 }}int zh_gpsDriver::CMD_Analysis( CMD_BUF * pcmd_buf ){char* pcmd。if( pcmd_bufsw ==1) {PDF(3,sentence: %s\n end\n,pcmd_bufbuf)。pcmd_bufbuf[0],$GPRMC)。pcmd[1])) { PDF(2,check sum error\n)。buf)。*/ } //2：判斷有效性。mpGPS_GPRMCgps_sw)。 if(mpGPS_GPRMCgps_sw==39。){ PDF(3,V invalid data\n)。buf)。 } //sscanf 并不能由空值來輸入浮點數(shù)。 i= sscanf(pcmd,%[^,],%[^,],%c,%lf,%c,%lf,%c,%lf,%lf,%[^,],%lf,%c,%s, mpGPS_GPRMCGpsid, mpGPS_GPRMCutc_time,amp。mpGPS_GPRMClatitude,amp。mpGPS_GPRMClongitude,amp。mpGPS_GPRMCspeed,amp。mpGPS_GPRMCmagneDeclinat,amp。 //請檢查 sscanf 的返回值，可能會失敗，如果小于要收得的數(shù)目。 mpGPS_GPRMCgps_sw=39。 CMDBUF_Init(amp。return 3。 mpGPS_GPRMClatitude=ddmm2dddd((mpGPS_GPRMClatitude/100))。 PDF(3,gps_sw=%c\n latitude=%lf\n lati_ns=%c\n, mpGPS_GPRMCgps_sw,mpGPS_GPRMClatitude, mpGPS_GPRMClati_ns)。 goto out。pcmd_bufbuf[0],$GPGSV)。pcmd[1])) { PDF(2,check sum error\n)。buf)。*/ } //sscanf 并不能由空值來輸入浮點數(shù)。mpGPS_GPGSVGSV_NOB,amp。mpGPS_GPGSVStaNOB, amp。mpGPS_GPGSV,amp。mpGPS_GPGSV, amp。mpGPS_GPGSV,amp。mpGPS_GPGSV, amp。mpGPS_GPGSV,amp。mpGPS_GPGSV, amp。mpGPS_GPGSV,amp。mpGPS_GPGSV, mpGPS_GPGSVsumCheck)。 GPGSV_Analysis(mpGPS_GPGSV)。 goto out。buf)。}void zh_gpsDriver::CMDBUF_Init( CMD_BUF * pcmd_buf ){ pcmd_bufpos=0。} int zh_gpsDriver::GetData(GPS_DATA amp。 =mpGPS_GPRMClatitude。 =mpGPS_GPRMCgps_sw。}int zh_gpsDriver::GetData(GPS_STASNR amp。}int zh_gpsDriver::setCOM(COM_PARAM amp。 struct termios attr。 = open(, O_RDWR |O_NONBLOCK)。 if ( == 1) {printf(open device:%s error!\n,)。} else printf(open device:%s ok!\n,)。attr)。return 1。attr,B4800)。attr,B4800)。return 1。attr,B9600)。attr,B9600)。return 1。 if((tcsetattr(fd,TCSANOW,amp。return 1。}void zh_gpsDriver::WfifoFixString(char data){ static int flag=0。,39。 else {if(flag==1) fifoctl(amp。039。 else flag=1。fifo,(int) data,WR)。 char c。 //================ for(j=0。j++) { readbytes = (int)read( fd, rdBuf, sizeof(rdBuf))。 for (i = 0 。 i++ ) {c = rdBuf[i]。} //================ while(GPRS_GetTextLineFromFIFO(amp。buf)。 } } PDF(3,zh_gpsDriver timer out!\n)。}Map 類程序：include //=====經(jīng)緯值define zhPR 8 //use for the zh point sizeint zhMap::CMD_Analysis( char * pcmd_buf ){ char* pcmd。 char msgid[20]。pcmd_buf[0],mapinfo:)。A_lont,amp。B_lont,amp。Width,amp。subWidth)。 if(i8) {PDF(2,sscanf error mapcfg\n)。} PDF(2,A_lont=%lf,A_lati=%lf, B_lont=%lf,B_lati=%lf\n,A_lont,A_lati, B_lont,B_lati)。 return 0。pcmd_buf[0],xxx)。}int zhMap::readMapCfg(QString Mapstr){ Mapstr+=/。//()。 FILE * infile。 PDF(2,OfilePtr=%s\n, OfilePtr)。t open file\n)。 } //================== while(fgets(msg, sizeof(msg), infile)!=NULL) { PDF(2,mapcfg=%s\n, msg)。 } fclose(infile)。 //======================}zhMap::zhMap(QWidget * parent ,const char * name):QWidget(parent,name){ /* A_lont=。//左上點緯度 B_lont=。//右下點緯度 Width=1080。 subWidth=300。 mapPath=()。 //=================== WidthNumber=Width/subWidth+1。///圖像垂直分割的個數(shù) pixPerLont=((double)Width)/(B_lontA_lont)。 //============= PDF(2,WidthNumber=%d HeightNumber=%d pixPerLont=%lf pixPerLati=%lf\n,WidthNumber,HeightNumber,pixPerLont,pixPerLati)。 Qstr){ QStrmappath=Qstr。 readMapCfg(QStrmappath)。//圖像水平分割的個數(shù) HeightNumber=Height/subWidth+1。 pixPerLati=((double)Height)/(A_latiB_lati)。}int zhMap::getMapABinfo(GPS_DATA amp。 B_gpsdata){ =A_lati。 =B_lati。}int zhMap::getCurrMap(const GPS_DATA amp。 pixmap){int xcenter,ycenter。int idA,idB,idC,idD。//int AxW,AyH。//判斷是否在范圍if(!(B_lont amp。 A_lont)){ PDF(1,out of lont range!\n)。}//out of range!if(!(A_lati amp。 B_lati)){ PDF(1,out of lati range!\n)。 }//out of range!!//中心點轉(zhuǎn)換成像素點xcenter=(int)(()*pixPerLont)。//==計算出請求圖的四點像素坐標(biāo)Ax=xcenter(zhGpsWidth)/2。Bx=Ax+zhGpsWidth。Cx=Ax。Dx=Bx。//由四點像素坐標(biāo)計算要裝載的圖片號。idj=Ay/subWidth。idi=Bx/subWidth+1。idB=idj*WidthNumber+idi。idj=Cy/subWidth。idi=Dx/subWidth+1。idD=idj*WidthNumber+idi。picloadFlag=(fileStr)。picloadFlag=(fileStr)。picloadFlag=(fileStr)。picloadFlag=(fileStr)。pixmap,this)。AyH=subWidthAy%subWidth。amp。//org x y