TiagoRG
/
it2s-itss-facilities
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

Added the ability for radar to reconnect (CPM)

This commit is contained in:
Marco 2021-04-23 15:47:39 +01:00
parent 88015dc131
commit ae5701bb87
1 changed files with 93 additions and 82 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

67
src/cpm.c
View File

@ -11,6 +11,7 @@
#include <signal.h> #include <signal.h>
#include <unistd.h> #include <unistd.h>
#include <syslog.h> #include <syslog.h>
#include <arpa/inet.h> #include <arpa/inet.h>
#include <stdbool.h> #include <stdbool.h>
@ -41,6 +42,26 @@ char* station_id;
it2s_config_t* config; it2s_config_t* config;
bool waitingIncomingConnection(void){
// Listening to the socket (Waiting for incoming connection)
unsigned int len = sizeof(s_socket.s_client);
if(listen(s_socket.i32_socket,1)<0){
syslog_err("Waiting for incoming requests failed...");
return false;
}
if((s_socket.i32_client = accept(s_socket.i32_socket, (struct sockaddr*)&s_socket.s_server, &len)) < 0){
syslog_err("Client disconnected...");
return false;
}
syslog_debug("Radar connected");
return true;
}
bool interface_connection(char* radar_ip,char* radar_port){ bool interface_connection(char* radar_ip,char* radar_port){
@ -63,26 +84,14 @@ bool interface_connection(char* radar_ip,char* radar_port){
return false; return false;
} }
if(!waitingIncomingConnection())
// 3 - Listening to the socket (Waiting for incoming connection)
unsigned int len = sizeof(s_socket.s_client);
if(listen(s_socket.i32_socket,1)<0){
syslog_err("Waiting for incoming requests failed...");
return false; return false;
}
if((s_socket.i32_client = accept(s_socket.i32_socket, (struct sockaddr*)&s_socket.s_server, &len)) < 0){
syslog_err("Client disconnected...");
return false;
}
syslog_debug("Radar connected");
return true; return true;
}
}
void parse_can_data_tm(u_int32_t u32_can_id, int i32_can_len, u_int8_t* au8_can_data) { void parse_can_data_tm(u_int32_t u32_can_id, int i32_can_len, u_int8_t* au8_can_data) {
u_int8_t u8_pvrMessagePart = 0; u_int8_t u8_pvrMessagePart = 0;
u_int8_t tmp = 0; u_int8_t tmp = 0;
@ -514,11 +523,9 @@ void *cp_service(void *fc){
/* Variables */ /* Variables */
int i32_recv_bytes; int i32_recv_bytes;
u_int8_t au8_readBuffer[READ_BUFFER_SIZE]; u_int8_t au8_readBuffer[READ_BUFFER_SIZE];
//void* message_data = malloc(1500);
uint8_t bdr_oer[2048]; uint8_t bdr_oer[2048];
bdr_oer[0] = 4; //Facilities bdr_oer[0] = 4; //Facilities
int is_radar_connected_error; bool is_radar_connected;
// socklen_t len = sizeof(error);
facilities_t *facilities = (facilities_t *) fc; facilities_t *facilities = (facilities_t *) fc;
@ -554,7 +561,8 @@ void *cp_service(void *fc){
*bdr->gnSecurityProfile = 1; *bdr->gnSecurityProfile = 1;
} }
interface_connection(RADAR_IP,RADAR_PORT); // Create Radar listening socket is_radar_connected = interface_connection(RADAR_IP,RADAR_PORT); // Create Radar listening socket
struct timespec* systemtime; struct timespec* systemtime;
systemtime = (struct timespec*)malloc(sizeof(struct timespec)); systemtime = (struct timespec*)malloc(sizeof(struct timespec));
if (systemtime == NULL) { if (systemtime == NULL) {
@ -563,20 +571,20 @@ void *cp_service(void *fc){
} }
while(!facilities->exit){ while(!facilities->exit){
usleep(1000*50); usleep(1000*50);
if (dissemination_check(facilities->dissemination) && facilities->dissemination->active){
/* Receive Data from radar interface */ /* Receive Data from radar interface */
CPM_t* cpm_tx = calloc(1, sizeof(CPM_t)); CPM_t* cpm_tx = calloc(1, sizeof(CPM_t));
i32_recv_bytes = recv(s_socket.i32_client, &au8_readBuffer, READ_BUFFER_SIZE, 0); //recv(socket,buffer,size,flags) i32_recv_bytes = recv(s_socket.i32_client, &au8_readBuffer, READ_BUFFER_SIZE, 0); //recv(socket,buffer,size,flags)
if (dissemination_check(facilities->dissemination) && facilities->dissemination->active){
if(is_radar_connected){
if(i32_recv_bytes < 0){ if(i32_recv_bytes <= 0){
syslog_debug("No data received from radar ..."); syslog_debug("No data received from radar ...");
break; is_radar_connected = false;
continue;
} }
/* Information parsing */ /* Information parsing */
@ -602,16 +610,19 @@ void *cp_service(void *fc){
queue_add(facilities->tx_queue, bdr_oer, enc.encoded+1, 3); queue_add(facilities->tx_queue, bdr_oer, enc.encoded+1, 3);
pthread_cond_signal(&facilities->tx_queue->trigger); pthread_cond_signal(&facilities->tx_queue->trigger);
/*Reset Timer for dissemination control */
/* Reset Timer for dissemination control */
dissemination_reset_timer(facilities->dissemination); dissemination_reset_timer(facilities->dissemination);
/* TODO: Send message to applications to send it to the broker ? *FacilitiesDataIndication*/ /*TODO: Send message to applications to send it to the broker ? *FacilitiesDataIndication*/
}else{ /* Waiting for Radar to reconnect */
is_radar_connected = waitingIncomingConnection();
}
} }
} }
ASN_STRUCT_FREE(asn_DEF_BTPDataRequest,bdr); ASN_STRUCT_FREE(asn_DEF_BTPDataRequest,bdr);
return NULL; return NULL;
} }