NEO_6M::NEO_6M(const char* adr)
{
if ((fd = Serial_Open(adr, NEO_6M_BAUD_RATE)) < 0)
throw std::runtime_error("Error openning the serial device!");
else
gps = new TinyGPSPlus();
}
static int serial_ensureopen() {
if (Serial_IsOpen() != 1) {
unsigned char mode[6] = {0, 5, 0, 0, 0, 0}; // 9600 bps 8n1
if (Serial_Open(mode) != 0) {
return 1;
}
}
return 0;
}
CPU_BOOLEAN App_SerialInit (void)
{
SERIAL_ERR err;
#if (APP_SERIAL_CFG_TRACE_EN == DEF_ENABLED)
SERIAL_IF_CFG uart_cfg;
#endif
Serial_Init(); /* Initial Serial module */
Serial_DevDrvAdd((CPU_CHAR *)"USART3", /* Add serial interface/device. */
(SERIAL_DEV_CFG *)&SerialDevCfg_STM32_USART3,
(CPU_SIZE_T ) 52u,
(CPU_SIZE_T ) 52u,
(SERIAL_ERR *)&err);
if (err != SERIAL_ERR_NONE) {
return (DEF_FAIL);
}
#if (APP_SERIAL_CFG_TRACE_EN == DEF_ENABLED)
uart_cfg.Baudrate = SERIAL_BAUDRATE_115200;
uart_cfg.DataBits = SERIAL_DATABITS_8;
uart_cfg.StopBits = SERIAL_STOPBITS_1;
uart_cfg.Parity = SERIAL_PARITY_NONE;
uart_cfg.FlowCtrl = SERIAL_FLOW_CTRL_NONE;
App_SerTraceIF_Nbr = Serial_Open((CPU_CHAR *)APP_SERIAL_CFG_TRACE_PORT_NAME,
(SERIAL_IF_CFG *)&uart_cfg,
(SERIAL_ERR *)&err);
if (err != SERIAL_ERR_NONE) {
return (DEF_FAIL);
}
Serial_SetLineDrv((SERIAL_IF_NBR ) App_SerTraceIF_Nbr,
(SERIAL_LINE_DRV_API *)&SerialLine_TTY ,
(SERIAL_ERR *)&err);
Serial_Wr((SERIAL_IF_NBR )App_SerTraceIF_Nbr,
(void *)"\n\n",
(CPU_SIZE_T )2u,
(CPU_INT32U )0u,
(SERIAL_ERR *)&err);
if (err != SERIAL_ERR_NONE) {
return (DEF_FAIL);
}
#endif
return (DEF_OK);
}
void ReadCode(char* code)
{
int fd;
int i;
char ch;
char buffer[2];
buffer[1] = 0;
i = 0;
fflush(stdin);
Serial_Open(&fd, "/dev/ttySP1", B9600);
WaitForChar(&fd, '-');
while(1)
{
Serial_Read(&fd, buffer, 1);
ch = buffer[0];
if(ch == '\n')
break;
code[i++] = ch;
}
code[i-1] = 0;
Serial_Close(&fd);
}
int main(int argc, char **argv)
{
if(argc == 1)
{
FILE *file;
char msg[50];
time_t mytime;
mytime = time(NULL);
while(1)
{
Message_Read(msg);
fprintf(stdout, "%s\n", msg);
time(&mytime);
file = fopen("LOG", "a+");
fprintf(file, "%s\t%s", msg, ctime(&mytime));
fclose(file);
}
}
if(argc == 2)
{
if(!strcmp(argv[1], "-config"))
{
int fd;
// char ch;
fprintf(stdout, "CONFIGURATING.......%s", "0%");
fflush(stdout);
Serial_Open(&fd, "/dev/ttySP1", B19200);
Serial_SendChar(&fd, '\n');
fprintf(stdout, "\rCONFIGURATING......%s", "10%");
fflush(stdout);
sleep(1);
Console_Read(fd);
fprintf(stdout, "\rCONFIGURATING......%s", "20%");
fflush(stdout);
Serial_SendChar(&fd, '1');
fprintf(stdout, "\rCONFIGURATING......%s", "30%");
fflush(stdout);
sleep(1);
Console_Read(fd);
fprintf(stdout, "\rCONFIGURATING......%s", "40%");
fflush(stdout);
Serial_SendChar(&fd, '1');
fprintf(stdout, "\rCONFIGURATING......%s", "50%");
fflush(stdout);
sleep(1);
Console_Read(fd);
fprintf(stdout, "\rCONFIGURATING......%s", "60%");
fflush(stdout);
Serial_SendChar(&fd, '2');
fprintf(stdout, "\rCONFIGURATING......%s", "70%");
fflush(stdout);
sleep(1);
Console_Read(fd);
fprintf(stdout, "\rCONFIGURATING......%s", "80%");
fflush(stdout);
Serial_SendChar(&fd, '1');
fprintf(stdout, "\rCONFIGURATING......%s", "90%");
fflush(stdout);
sleep(1);
Console_Read(fd);
fprintf(stdout, "\rCONFIGURATING.....%s\n", "100%");
fflush(stdout);
}
else if(!strcmp(argv[1], "--help") || !strcmp(argv[1], "-h"))
{
fputs("\
USAGE: ./%s\n\
./%s -config\n", argv[1], argv[1]);
}
else
{
