##// END OF EJS Templates
jro_hard » gen_acq
RSS
aaguilar - - Load All Authors

File last commit:

r96:97
r107:108
Show More
nmeaInfo.cpp
257 lines | 4.6 KiB | text/x-c | CppLexer
/ trunk / firmware / sources / saigd / nmealib++ / nmeaInfo.cpp
History | Source | Raw |Copy content |Copy permalink
aaguilar
codigo fuente de librería NMEAlib++ basado en el codigo original de:...
 r96 /*
* nmeaInfo.cpp
*
* Created on: Oct 21, 2014
* Author: Alan Aguilar Sologuren
*/
#include "utils.h"
#include "nmeaInfo.h"
nmeaInfo::nmeaInfo() {
// TODO Auto-generated constructor stub
}
nmeaInfo::~nmeaInfo() {
// TODO Auto-generated destructor stub
}
void nmeaInfo::code_init_INFO()
{
code_time_now();
sig = NMEA_SIG_BAD;
fix = NMEA_FIX_BAD;
}
static void nmeaInfo::code_time_now() {
time_t lt;
struct tm *tt;
time(&lt);
tt = gmtime(&lt);
utc.year = tt->tm_year;
utc.mon = tt->tm_mon;
utc.day = tt->tm_mday;
utc.hour = tt->tm_hour;
utc.min = tt->tm_min;
utc.sec = tt->tm_sec;
utc.hsec = 0;
}
/**
* \brief Convert position from INFO to radians position
*/
void nmeaInfo::code_info2pos(nmeaPOS *pos) {
pos->lat = code_ndeg2radian(lat);
pos->lon = code_ndeg2radian(lon);
}
/**
* \brief Convert radians position to INFOs position
*/
void nmeaInfo::code_pos2info(const nmeaPOS *pos) {
lat = code_radian2ndeg(pos->lat);
lon = code_radian2ndeg(pos->lon);
}
/*
* NOISE generator
*/
int nmeaInfo::nmea_igen_noise_init()
{
return 1;
}
int nmeaInfo::nmea_igen_noise_loop()
{
int it;
int in_use;
sig = (int)nmea_random(1, 3);
PDOP = nmea_random(0, 9);
HDOP = nmea_random(0, 9);
VDOP = nmea_random(0, 9);
fix = (int)nmea_random(2, 3);
lat = nmea_random(0, 100);
lon = nmea_random(0, 100);
speed = nmea_random(0, 100);
direction = nmea_random(0, 360);
declination = nmea_random(0, 360);
elv = (int)nmea_random(-100, 100);
satinfo.inuse = 0;
satinfo.inview = 0;
for(it = 0; it < 12; ++it)
{
satinfo.sat[it].id = it;
satinfo.sat[it].in_use = in_use = (int)nmea_random(0, 3);
satinfo.sat[it].elv = (int)nmea_random(0, 90);
satinfo.sat[it].azimuth = (int)nmea_random(0, 359);
satinfo.sat[it].sig = (int)(in_use?nmea_random(40, 99):nmea_random(0, 40));
if(in_use)
satinfo.inuse++;
if(satinfo.sat[it].sig > 0)
satinfo.inview++;
}
return 1;
}
int nmeaInfo::nmea_igen_noise_reset()
{
return 1;
}
/*
* STATIC generator
*/
int nmeaInfo::nmea_igen_static_loop()
{
code_time_now();
return 1;
};
int nmeaInfo::nmea_igen_static_reset()
{
satinfo.inuse = 4;
satinfo.inview = 4;
satinfo.sat[0].id = 1;
satinfo.sat[0].in_use = 1;
satinfo.sat[0].elv = 50;
satinfo.sat[0].azimuth = 0;
satinfo.sat[0].sig = 99;
satinfo.sat[1].id = 2;
satinfo.sat[1].in_use = 1;
satinfo.sat[1].elv = 50;
satinfo.sat[1].azimuth = 90;
satinfo.sat[1].sig = 99;
satinfo.sat[2].id = 3;
satinfo.sat[2].in_use = 1;
satinfo.sat[2].elv = 50;
satinfo.sat[2].azimuth = 180;
satinfo.sat[2].sig = 99;
satinfo.sat[3].id = 4;
satinfo.sat[3].in_use = 1;
satinfo.sat[3].elv = 50;
satinfo.sat[3].azimuth = 270;
satinfo.sat[3].sig = 99;
return 1;
}
int nmeaInfo::nmea_igen_static_init()
{
sig = 3;
fix = 3;
nmea_igen_static_reset();
return 1;
}
/*
* SAT_ROTATE generator
*/
int nmeaInfo::nmea_igen_rotate_loop()
{
int it;
int count = satinfo.inview;
double deg = 360 / (count?count:1);
double srt = (count?(satinfo.sat[0].azimuth):0) + 5;
code_time_now();
for(it = 0; it < count; ++it)
{
satinfo.sat[it].azimuth =
(int)((srt >= 360)?srt - 360:srt);
srt += deg;
}
return 1;
};
int nmeaInfo::nmea_igen_rotate_reset()
{
int it;
double deg = 360 / 8;
double srt = 0;
satinfo.inuse = 8;
satinfo.inview = 8;
for(it = 0; it < satinfo.inview; ++it)
{
satinfo.sat[it].id = it + 1;
satinfo.sat[it].in_use = 1;
satinfo.sat[it].elv = 5;
satinfo.sat[it].azimuth = (int)srt;
satinfo.sat[it].sig = 80;
srt += deg;
}
return 1;
}
int nmeaInfo::nmea_igen_rotate_init()
{
sig = 3;
fix = 3;
nmea_igen_rotate_reset();
return 1;
}
/*
* POS_RANDMOVE generator
*/
int nmeaInfo::nmea_igen_pos_rmove_init()
{
sig = 3;
fix = 3;
direction = declination = 0;
speed = 20;
return 1;
}
int nmeaInfo::nmea_igen_pos_rmove_loop()
{
nmeaPOS crd;
direction += nmea_random(-10, 10);
speed += nmea_random(-2, 3);
if(direction < 0)
direction = 359 + direction;
if(direction > 359)
direction -= 359;
if(speed > 40)
speed = 40;
if(speed < 1)
speed = 1;
code_info2pos(&crd);
code_move_horz(&crd, &crd, direction, speed / 3600);
code_pos2info(&crd);
declination = direction;
return 1;
};