gps.h

Go to the documentation of this file.

/*
 * Copyright (C) 2003-2011 The Paparazzi Team
 *
 * This file is part of paparazzi.
 *
 * paparazzi is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2, or (at your option)
 * any later version.
 *
 * paparazzi is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with paparazzi; see the file COPYING.  If not, write to
 * the Free Software Foundation, 59 Temple Place - Suite 330,
 * Boston, MA 02111-1307, USA.
 */

#ifndef GPS_H
#define GPS_H


#include "std.h"
#include "math/pprz_geodetic_int.h"

#include "mcu_periph/sys_time.h"

/* GPS model specific implementation or sim */
#ifdef GPS_TYPE_H
#include GPS_TYPE_H
#endif

#define GPS_FIX_NONE 0x00     
#define GPS_FIX_2D   0x02     
#define GPS_FIX_3D   0x03     
#define GPS_FIX_DGPS 0x04     
#define GPS_FIX_RTK  0x05     

#define GpsFixValid() (gps.fix >= GPS_FIX_3D)
#if USE_GPS
#define GpsIsLost() !GpsFixValid()
#endif

#ifndef GPS_NB_CHANNELS
#define GPS_NB_CHANNELS 1
#endif

struct SVinfo {
  uint8_t svid;  
  uint8_t flags; 
  uint8_t qi;    
  uint8_t cno;   
  int8_t elev;   
  int16_t azim;  
};

struct GpsState {
  struct EcefCoor_i ecef_pos;    
  struct LlaCoor_i lla_pos;      
  struct UtmCoor_i utm_pos;      
  int32_t hmsl;                  
  struct EcefCoor_i ecef_vel;    
  struct NedCoor_i ned_vel;      
  uint16_t gspeed;               
  uint16_t speed_3d;             
  int32_t course;                
  uint32_t pacc;                 
  uint32_t sacc;                 
  uint32_t cacc;                 
  uint16_t pdop;                 
  uint8_t num_sv;                
  uint8_t fix;                   
  uint16_t week;                 
  uint32_t tow;                  

  uint8_t nb_channels;           
  struct SVinfo svinfos[GPS_NB_CHANNELS]; 

  uint32_t last_3dfix_ticks;     
  uint32_t last_3dfix_time;      
  uint32_t last_msg_ticks;       
  uint32_t last_msg_time;        
  uint16_t reset;                
};

struct GpsTimeSync {
  uint32_t t0_tow;      
  int32_t t0_tow_frac;  
  uint32_t t0_ticks;    
};

extern struct GpsState gps;

extern void gps_init(void);

extern void gps_impl_init(void);

extern void gps_inject_data(uint8_t packet_id, uint8_t length, uint8_t *data);

#ifndef GPS_TIMEOUT
#define GPS_TIMEOUT 2
#endif

static inline bool_t gps_has_been_good(void)
{
  static bool_t gps_had_valid_fix = FALSE;
  if (GpsFixValid()) {
    gps_had_valid_fix = TRUE;
  }
  return gps_had_valid_fix;
}


extern void gps_periodic_check(void);

#define gps_Reset(_val) {                               \
  }


/*
 * For GPS time synchronizaiton...
 */
extern struct GpsTimeSync gps_time_sync;

extern uint32_t gps_tow_from_sys_ticks(uint32_t sys_ticks);

#endif /* GPS_H */