gps示例代码

/* main.c */
#include <sys/types.h>
#include <sys/stat.h>
#include <fcntl.h>
#include <errno.h>
#include <stdio.h>
#include <string.h>
#include <unistd.h>
#include <stdlib.h>
#include <getopt.h>
#include "gps.h"
#include "serial.h"
 
#define GPS_LEN 1024
 
static char *dev_name = "/dev/ttyS2";
static int baud_rate = ;
static unsigned int loop_time = ;
static struct option opts[] = {
    {"device", required_argument, NULL, 'd'},
    {"baud", required_argument, NULL, 'b'},
    {"loop", required_argument, NULL, 'l'},
    {"help", no_argument, NULL, 'h'},
};
 
static void parse_cmd(int argc, char *argv[])
{
    int ch;
 
    while ((ch = getopt_long(argc, argv, "d:b:l:h", opts, NULL)) != -) {
        switch (ch) {
        case 'd':
            //printf("dev_name: %s\n", optarg);
            dev_name = optarg;
            break;
        case 'b':
            //printf("baud_rate: %s\n", optarg);
            baud_rate = atoi(optarg);
            break;
        case 'l':
            //printf("loop_time: %s\n", optarg);
            loop_time = atoi(optarg);
            break;
        case 'h':
            printf("Usage: %s -d dev_name -b baud_rate\n", argv[]);
            printf("like:\n");
            printf("\t %s -d /dev/ttyS2\n", argv[]);
            printf("\t %s --device /dev/ttyS2 -b 9600\n", argv[]);
            break;
        default:
            printf("Unknown option or invalid format!\n");
            printf("Pls: %s --help for more info\n", argv[]);
            break;
        }
    }
}
 
int main(int argc, char *argv[])
{
    int fd=;
    int cnt=;
    char buff[GPS_LEN];
 
    parse_cmd(argc, argv);
    printf("dev_name=%s, baud_rate=%d\n", dev_name, baud_rate);
 
    fd = open(dev_name,O_RDWR|O_NOCTTY|O_NDELAY);
    if(fd < ) {
        printf("Can't Open %s\n", dev_name);
        return -;
    }
 
    set_serial(fd, baud_rate, , 'N', );
 
    while(loop_time--) {
        memset(buff,  , GPS_LEN);
        sleep();
        cnt = read(fd, buff, GPS_LEN);
        if(cnt<) {
            printf("read error\n");
            return -;
        }
        printf("read cnt: %d, as fallow:\n%s\n", cnt, buff);
 
        if(cnt)
            gps_analyse(buff);
 
    }
 
    close(fd);
    return ;
}

main.c

#include <string.h>
#include <stdio.h>
#include "gps.h"
 
void print_gprmc(struct gprmc *gprmc_data)
{
    printf("===================== GPRMC ====================\n");
    printf("==   GPS state bit : %c  [A:有效状态 V:无效状态]\n", gprmc_data->pos_state);
    printf("==   GPS mode  bit : %c  [A:自主定位 D:差分定位]\n", gprmc_data->mode);
    printf("==   Date : 20%02d-%02d-%02d                    \n", gprmc_data->date%,(gprmc_data->date%)/,gprmc_data->date/);
    printf("==   Time : %02d:%02d:%02d                      \n", (gprmc_data->time/+)%,(gprmc_data->time%)/,gprmc_data->time%);
    printf("==   纬度 : 北纬:%d度%d分%d秒                   \n", ((int)gprmc_data->latitude) / , (int)(gprmc_data->latitude - ((int)gprmc_data->latitude /  * )), (int)(((gprmc_data->latitude - ((int)gprmc_data->latitude /  * )) - ((int)gprmc_data->latitude - ((int)gprmc_data->latitude /  * ))) * 60.0));
    printf("==   经度 : 东经:%d度%d分%d秒                   \n", ((int)gprmc_data->longitude) / , (int)(gprmc_data->longitude - ((int)gprmc_data->longitude /  * )), (int)(((gprmc_data->longitude - ((int)gprmc_data->longitude /  * )) - ((int)gprmc_data->longitude - ((int)gprmc_data->longitude /  * ))) * 60.0));
    printf("==   速度 : %.3f  m/s                           \n", gprmc_data->speed);
    printf("================================================\n");
}
 
void gprmc_analyse(char *buff)
{
    char *ptr=NULL;
    struct gprmc gprmc_data;
 
    /* FIXME:
     *     1. 002743.261 the last '261' will change so sometime can not match
     *    2. only attach once from buff, maybe should use while(ptr != NULL) ...
     */
    /* eg: $GPRMC,002743.261,V,,,,,0.00,0.00,060180,,,N*45 */
    if(NULL != (ptr=strstr(buff, "$GPRMC"))) {
        sscanf(ptr, "$GPRMC,%d.261,%c,%f,N,%f,E,%f,%f,%d,,,%c*",
            &(gprmc_data.time), &(gprmc_data.pos_state), &(gprmc_data.latitude),
            &(gprmc_data.longitude), &(gprmc_data.speed), &(gprmc_data.direction),
            &(gprmc_data.date), &(gprmc_data.mode));
 
        print_gprmc(&gprmc_data);
    }
}
 
void gps_analyse(char *buff)
{
    gprmc_analyse(buff);
    //gpgsv_analyse(buff); // do more type parse
}

gps.c

#ifndef __GPS_H__
#define __GPS_H__
 
struct gprmc
{
    unsigned int time;/* gps定位时间 */
    char pos_state;/*gps状态位*/
    float latitude;/*纬度 */
    float longitude;/* 经度 */
    float speed; /* 速度 */
    float direction;/*航向 */
    unsigned int date;  /*日期  */
    float declination; /* 磁偏角 */
    char dd;
    char mode;/* GPS模式位 */
};
 
extern void gps_analyse(char *buff);
 
#endif

gps.h

#include <stdio.h>
#include <termios.h>
#include <stdlib.h>
#include <string.h>
#include "serial.h"
 
int set_serial(int fd, int baud_rate, int nBits, char nEvent, int nStop)
{
    struct termios tty_cfg;
 
    memset(&tty_cfg, , sizeof(tty_cfg));
    tty_cfg.c_cflag |= (CLOCAL|CREAD); /* CREAD 开启串行数据接收，CLOCAL并打开本地连接模式 */
    tty_cfg.c_cflag &= ~CSIZE; /* 设置数据位 */
 
    switch(baud_rate) {
    case :
        cfsetispeed(&tty_cfg, B2400);
        cfsetospeed(&tty_cfg, B2400);
        break;
    case :
        cfsetispeed(&tty_cfg, B4800);
        cfsetospeed(&tty_cfg, B4800);
        break;
    case :
        cfsetispeed(&tty_cfg, B9600);
        cfsetospeed(&tty_cfg, B9600);
        break;
    case :
        cfsetispeed(&tty_cfg, B115200);
        cfsetospeed(&tty_cfg, B115200);
        break;
    default:
        cfsetispeed(&tty_cfg, B9600);
        cfsetospeed(&tty_cfg, B9600);
        break;
    }
 
    switch(nBits) {
    case :
        tty_cfg.c_cflag |= CS7;
        break;
    case :
        tty_cfg.c_cflag |= CS8;
        break;
    }
 
    switch(nEvent) {
    case '':  /* 奇校验 */
        tty_cfg.c_cflag |= PARENB; /* 开启奇偶校验 */
        tty_cfg.c_iflag |= (INPCK | ISTRIP); /*INPCK打开输入奇偶校验；ISTRIP去除字符的第八个比特  */
        tty_cfg.c_cflag |= PARODD; /*启用奇校验(默认为偶校验)*/
        break;
    case 'E': /*偶校验*/
        tty_cfg.c_cflag |= PARENB; /*开启奇偶校验  */
        tty_cfg.c_iflag |= ( INPCK | ISTRIP); /*打开输入奇偶校验并去除字符第八个比特*/
        tty_cfg.c_cflag &= ~PARODD; /*启用偶校验*/
        break;
    case 'N': /*无奇偶校验*/
        tty_cfg.c_cflag &= ~PARENB;
        break;
    }
 
    /* 设置停止位；若停止位为1，则清除CSTOPB，若停止位为2，则激活CSTOPB */
    if(nStop == )
        tty_cfg.c_cflag &= ~CSTOPB; /*默认为一位停止位； */
    else if( nStop == )
        tty_cfg.c_cflag |= CSTOPB; /* CSTOPB表示送两位停止位 */
 
    /* 设置最少字符和等待时间，对于接收字符和等待时间没有特别的要求时*/
    tty_cfg.c_cc[VTIME] = ; /* 非规范模式读取时的超时时间；*/
    tty_cfg.c_cc[VMIN]  = ; /* 非规范模式读取时的最小字符数*/
    tcflush(fd, TCIFLUSH); /* tcflush清空终端未完成的输入/输出请求及数据；TCIFLUSH表示清空正收到的数据，且不读取出来 */
 
    /*激活配置使其生效*/
    if((tcsetattr(fd, TCSANOW, &tty_cfg)) != ) {
        printf("com set error");
        exit();
    }
 
    return ;
}

serial.c

#ifndef __FUZK_SERIAL_H__
#define __FUZK_SERIAL_H__
 
extern int set_serial(int fd, int baud_rate, int nBits, char nEvent, int nStop);
 
#endif

serial.h

CC = /opt/toolchain/arm-2012.03/bin/arm-none-linux-gnueabi-gcc
CFLAGS = -O1
 
TARGET = gps_test
OBJS = serial.o gps.o main.o
 
$(TARGET): $(OBJS)
    $(CC) -o $(TARGET) $(OBJS) $(CFLAGS)
 
$(OBJS): %o:%c
    $(CC) -c $(CFLAGS) $< -o $@
 
clean:
    rm -f $(TARGET) $(OBJS)

Makefile