#include <stdio.h>

#include <stdlib.h>

#include <string.h>

#include <unistd.h>

#include <stdbool.h>

#include <errno.h>

#include <getopt.h>

#include <signal.h>

#include <time.h>

#include <math.h>

// includes for socket

#include <sys/types.h>

#include <sys/socket.h>

#include <netinet/in.h>

#include <arpa/inet.h>

#include "lib/log.h"

#include "frames.h"

#include "lib/tools.h"

#define UDP_DEFAULT_PORT 4490

int udpPort =UDP_DEFAULT_PORT;

int verboseLevel= 1;

int defaultLapse = 5;

char ip[20] = "127.0.0.1";

bool addCnxFrame = false;

bool terminate = false;

bool sendFile = false;

char *fileName;

#define MPS_TO_KNOTS 1.94384

#define MPS_TO_KMPH 3.6

#define MAX_MPS 36

const char *TAG="TXs";

void help() {

printf("txs v1.0 Very Simple frame sender simulator \n\n"

"Syntaxis:\n"

"\n\ttxs [ -h | --help ] [-i | --ip < ip_server > ][ -p | --port <udp_port> ] [-c | --cnx ] [ -l | --lapse ] [ -f | --file ] [ -v | --verbose < 0 | 1 | 2 > ] \n"

"\n\twhere:\n"

"\t -h | --help : Shows this help.\n"

"\t -i | --ip : Ip server.\n"

"\t -p | --port : UDP port to listen.\n"

"\t -c | --cnx : Append a connection frame.\n"

"\t -f | --file : Send file content. \n"

"\t -l | --lapse : Time lapse to send frames.\n"

"\t -v | --verbose : Sets the verbose level( 0 Error , 1 Notice, 2 Debug )\n"

);

}

void die(char *msg) {

fprintf(stderr,msg);

exit(EXIT_FAILURE);

}

int sendFileContent(char *ip,int port, char *fileName) {

char buff[TRANS_MAX_BUFF_SIZE];

size_t transLen;

int seq =0;

int sckt;

FILE *fin;

struct sockaddr_in server;

// INIT SOCKET

printf("Incializando...\n");

memset(&server,0,sizeof(server));

sckt= socket(AF_INET,SOCK_DGRAM,0);

if (sckt<0) {

die("Error en la creacion del socket");

}

server.sin_family = AF_INET;

server.sin_addr.s_addr = inet_addr(ip);

server.sin_port = htons(port);

fin = fopen(fileName,"r");

if (!fin) {

die("No se pudo abrir el fichero");

}

transLen=fread(buff,1,sizeof(buff),fin);

sendto(sckt,buff,transLen,0,(struct sockaddr *)&server,sizeof(server));

printf("Enviados %d bytes.\n",transLen);

close(sckt);

fclose(fin);

return 0;

}

int runSimulator(char *ip, int port) {

int bear;

int knots;

int mps=0;

int myTime =0;

int lapse=defaultLapse;

long x, y, d;

float lat, lon;

frm_cmd_gps_t gps;

char buff[TRANS_MAX_BUFF_SIZE];

size_t transLen;

int seq =0;

int sckt;

struct sockaddr_in server;

// INIT SOCKET

printf("Incializando...\n");

memset(&server,0,sizeof(server));

sckt= socket(AF_INET,SOCK_DGRAM,0);

if (sckt<0) {

die("Error en la creacion del socket");

}

server.sin_family = AF_INET;

server.sin_addr.s_addr = inet_addr(ip);

server.sin_port = htons(port);

y = lat2y(42.22);

x = lon2x(-8.65);

printf("Empezando simulacion...(lapso=%ds)\n\n",lapse);

while (true) {

if (myTime<=0) {

myTime = rnd1(30);

bear = rnd0(359);

mps = rnd1(MAX_MPS);

}

d = mps * lapse;

// Ojo origen de rumbo PI

y += round( d * cos(bear * DEG_RAD));

x += round( d * sin(bear * DEG_RAD));

lat = y2lat(y);

lon = x2lon(x);

knots = mps * MPS_TO_KNOTS;

// gps.cmd = 0x11;

// gps.len =0;

// gps.seq_l= seq++;

// gps.seq_s=0;

// gps.bearing = GPS_ENCODE_BEARING(bear);

// gps.knots = knots;

// gps.lat_sign = lat<0?1:0;

// gps.lat_deg = gps.lat_sign?-lat:lat;

// gps.lat_min =htons(GPS_ENCODE_LOCMIN(lat));

// gps.lon_sign = lon<0?1:0;

// gps.lon_deg = gps.lon_sign?-lon:lon;

// gps.lon_min = htons(GPS_ENCODE_LOCMIN(lon));

//

// gps.fix = 1;

// gps.hdop = rnd1(20);

// gps.time.epoch = htonl(time(NULL));

int offset=0;

transLen = sizeof(buff);

frame_encode_gps(seq++,bear,knots,lat,lon,1,rnd1(20),0,buff,&transLen);

offset +=transLen;

if (addCnxFrame) {

transLen = sizeof(buff) - offset;

frame_encode_cnx("1234567890",0,1,0,buff+offset,&transLen);

offset +=transLen;

}

transLen = sizeof(buff);

if ( frame_encode_transport(1,NULL,offset,buff,&transLen) ) {

// if (frame_test_transport(buff,transLen)) {

// printf("Trama de transporte verificada\n");

// }

printf("Enviando: %d lat=%f lon=%f bear=%d knots=%d time=%d\n",seq,

lat,lon,bear,knots,ntohl(gps.time.epoch));

sendto(sckt,buff,transLen,0,(struct sockaddr *)&server,sizeof(server));

}

myTime -=lapse;

sleep(lapse);

}

close(sckt);

return 0;

}

void parseArgs(int argc, char **argv) {

bool noArgs = true;

static struct option longOptions[] = {

{"help",0,0,'h'},

{"ip",1,0,'i'},

{"port",1,0,'p'},

{"file",1,0,'f'},

{"cnx",0,0,'c'},

{"lapse",1,0,'l'},

{"verbose",1,0,'v'},

{0,0,0,0}

};

//Parseo de parametros;

int c;

while ( (c = getopt_long(argc,argv,"hcf:i:p:l:v:n",longOptions,NULL)) != -1) {

if (noArgs)

noArgs = false;

switch(c) {

case 'i':

strcpy(ip,optarg);

break;

case 'p':

udpPort = atoi(optarg);

break;

case 'f':

sendFile = true;

fileName = optarg;

break;

case 'c':

addCnxFrame = true;

break;

case 'l':

defaultLapse = atoi(optarg);

break;

case 'v':

verboseLevel = atoi(optarg);

break;

default:

help();

exit(EXIT_FAILURE);

}

}

if (noArgs) {

help();

exit(EXIT_FAILURE);

}

}

int doTestAndDie() {

long x,y;

float lat, lon,lat2,lon2;

int lat_sign, lat_deg, lat_min;

int lon_sign, lon_deg, lon_min;

lat = 42.22;

lon = -8.65;

y = lat2y(lat);

x = lon2x(lon);

lat_sign=lat<0?1:0;

lat_deg = lat_sign?-lat:lat;

lat_min = GPS_ENCODE_LOCMIN(lat);

lon_sign=lon<0?1:0;

lon_deg = lon_sign?-lon:-lon;

lon_min = GPS_ENCODE_LOCMIN(lon);

lat2 = GPS_DECODE_LOC(lat_sign, lat_deg, lat_min);

lon2 = GPS_DECODE_LOC(lon_sign, lon_deg, lon_min);

printf("Test:\n\t Lat: %f\tLon:%f\n"

"\t Lat: %d %d %d \n"

"\t Lon: %d \%d \%d \n"

"\t Lat2: %f\tLon2: %f\n",

lat,lon,lat_sign,lat_deg,lat_min,

lon_sign, lon_deg, lon_min,lat2,lon2);

exit(0);

}

int main(int argc, char **argv) {

int exitCode;

//doTestAndDie();

parseArgs(argc,argv);

if (sendFile)

exitCode = sendFileContent(ip,udpPort,fileName);

else

exitCode = runSimulator(ip,udpPort);

return exitCode;

//return EXIT_SUCCESS;

}