-
Notifications
You must be signed in to change notification settings - Fork 573
Commit
This commit does not belong to any branch on this repository, and may belong to a fork outside of the repository.
Merge pull request #1 from manish1-garg/csi_changes
framework/src/csifw: UDP server support to send CSI data to UDP client
- Loading branch information
Showing
7 changed files
with
448 additions
and
0 deletions.
There are no files selected for viewing
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
| Original file line number | Diff line number | Diff line change |
|---|---|---|
| @@ -0,0 +1,209 @@ | ||
| #include "include/CSILogsDumper.h" | ||
| #include <sys/socket.h> | ||
| #include <netdb.h> | ||
| #include <pthread.h> | ||
| #include <errno.h> | ||
|
|
||
| #define PORT 5000 | ||
| #define CONTROL_COMMAND_BUFFER_SIZE 128 | ||
| #define CSI_DATA_DUMP_BUFFER_SIZE 1024 | ||
|
|
||
| unsigned char gCSIDataDumpBuffer[CSI_DATA_DUMP_BUFFER_SIZE]; | ||
| char gControlCommandBuffer[CONTROL_COMMAND_BUFFER_SIZE]; | ||
|
|
||
| csiDataDumpListener gListener = NULL; | ||
| static pthread_t gThreadId = -1; | ||
| static int gSockFd = -1, gFifoFd = -1; | ||
| struct sockaddr_in gServerAddr, gClientAddr; | ||
| socklen_t gClientLen = sizeof(gClientAddr); | ||
| fd_set readfds; | ||
| int maxfd; | ||
|
|
||
| static int gWaitingForData = 0; | ||
| static int gRemainingBytes = 0; | ||
| static int gBytesReadSofar = 0; | ||
|
|
||
| static int recv_message(int fd, void *buf, int buflen) | ||
| { | ||
| int received = 0; | ||
| while (1) { | ||
| int res = read(fd, buf + received, buflen - received); | ||
| if (res < 0) { | ||
| int err_no = errno; | ||
| if (err_no == EAGAIN || err_no == EINTR) { | ||
| continue; | ||
| } | ||
| CSIFW_LOGE("read error %d\n", err_no); | ||
| return -1; | ||
| } | ||
| received += res; | ||
| if (received == buflen) { | ||
| break; | ||
| } | ||
| } | ||
| return received; | ||
| } | ||
|
|
||
| static int print_log(const char *format, ...) | ||
| { | ||
| va_list args; | ||
| va_start(args, format); | ||
| vprintf(format, args); | ||
| va_end(args); | ||
| return 1; | ||
| } | ||
|
|
||
| static void print_buf(const unsigned char* buf, int len) | ||
| { | ||
| print_log("\n RAW DATA %d\n\n", len); | ||
| unsigned long long *buff_tmp = (u64 *)buf; | ||
| int buff_len = (len/8) + 1; | ||
| for (int i = 0; i < buff_len; i++) | ||
| print_log("[%02d]0x%016llx\n", i, buff_tmp[i]); | ||
| } | ||
|
|
||
| void set_event_listener(csiDataDumpListener listener) | ||
| { | ||
| gListener = listener; | ||
| } | ||
|
|
||
| void *dataTransmitter(void *arg) | ||
| { | ||
| int len; | ||
| while (1) { | ||
| FD_ZERO(&readfds); | ||
| FD_SET(gSockFd, &readfds); | ||
| FD_SET(gFifoFd, &readfds); | ||
| maxfd = (gSockFd > gFifoFd) ? gSockFd : gFifoFd; | ||
|
|
||
| CSIFW_LOGI("Wait for an activity on one of the file descriptors"); | ||
| int ret = select(maxfd + 1, &readfds, NULL, NULL, NULL); | ||
| if (ret < 0) { | ||
| if (errno == EBADF){ | ||
| CSIFW_LOGE("select operation failed due to file descripter close: %d", errno); | ||
| return; | ||
| } | ||
| else if(errno == EINTR){ | ||
| CSIFW_LOGE("select operation failed due to Temporary Interrupt: %d", errno); | ||
| continue;; | ||
| } | ||
| CSIFW_LOGE("select operation failed over file descripters: %d", errno); | ||
| return; | ||
| } | ||
|
|
||
| // Check if there's data on the UDP socket | ||
| if (FD_ISSET(gSockFd, &readfds)) { | ||
| CSIFW_LOGI("Received an activity on sockfd descriptors"); | ||
| len = recvfrom(gSockFd, gControlCommandBuffer, CONTROL_COMMAND_BUFFER_SIZE-1, 0, (struct sockaddr *)&gClientAddr, &gClientLen); | ||
| if (len < 0) { | ||
| continue; | ||
| } | ||
| gControlCommandBuffer[len] = '\0'; | ||
| if (strncmp(gControlCommandBuffer, "START", 6) == 0) { | ||
| gListener(START_DUMP); | ||
| CSIFW_LOGI("Received START command. Starting to send data to client from FIFO"); | ||
| } else if (strncmp(gControlCommandBuffer, "STOP", 5) == 0) { | ||
| gListener(STOP_DUMP); | ||
| CSIFW_LOGI("Received STOP command. Stopping data transfer to client from FIFO"); | ||
| } else { | ||
| CSIFW_LOGI("Received unknown command: %s", gControlCommandBuffer); | ||
| continue; | ||
| } | ||
| } | ||
|
|
||
| // Check if there's data on the FIFO | ||
| if (FD_ISSET(gFifoFd, &readfds)) { | ||
| CSIFW_LOGI("Received an activity on Fifo descriptors"); | ||
|
|
||
| if (!gWaitingForData) { | ||
| // Get the length from the first 2 bytes | ||
| len = recv_message(gFifoFd, (void *)gCSIDataDumpBuffer, 2); | ||
| if (len <= 0) { | ||
| CSIFW_LOGE("operation to read length of data from FIFO Failed"); | ||
| continue; | ||
| } | ||
| uint16_t length; | ||
| memcpy(&length , gCSIDataDumpBuffer, sizeof(length)); | ||
| CSIFW_LOGI("Read %d length to client:", length); | ||
| gRemainingBytes = length; | ||
| gWaitingForData = 1; | ||
| gBytesReadSofar = 0; | ||
| } | ||
| if (gWaitingForData) { | ||
| // We are expecting to read the actual data | ||
| ssize_t bytes_read = read(gFifoFd, gCSIDataDumpBuffer + gBytesReadSofar, gRemainingBytes); | ||
| if (bytes_read < 0) { | ||
| int err_no = errno; | ||
| if (err_no == EAGAIN || err_no == EINTR) { | ||
| continue; | ||
| } | ||
| CSIFW_LOGE("read error %d\n", err_no); | ||
| continue; // or return | ||
| } | ||
|
|
||
| gBytesReadSofar += bytes_read; | ||
| gRemainingBytes -= bytes_read; | ||
|
|
||
| if (gRemainingBytes == 0) { | ||
| // Complete data received | ||
| gWaitingForData = 0; | ||
| // Send the data to the client | ||
| len = sendto(gSockFd, gCSIDataDumpBuffer, gBytesReadSofar, 0, (struct sockaddr *)&gClientAddr, sizeof(gClientAddr)); | ||
| if (len == -1) { | ||
| CSIFW_LOGE("sendto error:%d", errno); | ||
| continue; | ||
| } | ||
| CSIFW_LOGI("Sent %d bytes to client", len); | ||
| print_buf(gCSIDataDumpBuffer,len); | ||
| } | ||
| } | ||
| } | ||
| } | ||
| } | ||
|
|
||
| CSIFW_RES csi_logs_dumper_init() | ||
| { | ||
| if ((gSockFd = socket(AF_INET, SOCK_DGRAM, 0)) < 0) { | ||
| CSIFW_LOGE("failed to create a socket fd"); | ||
| return CSIFW_ERROR; | ||
| } | ||
|
|
||
| memset(&gServerAddr, 0, sizeof(gServerAddr)); | ||
| gServerAddr.sin_family = AF_INET; | ||
| gServerAddr.sin_addr.s_addr = INADDR_ANY; | ||
| gServerAddr.sin_port = htons(PORT); | ||
|
|
||
| if (bind(gSockFd, (struct sockaddr*)&gServerAddr, sizeof(gServerAddr)) < 0) { | ||
| CSIFW_LOGE("binding socket failed"); | ||
| close(gSockFd); | ||
| return CSIFW_ERROR; | ||
| } | ||
| printf("server Socket Created\n"); | ||
| gFifoFd = open(CSI_DUMP_DATA_QUEUE_NAME, O_RDONLY | O_NONBLOCK); | ||
| if (gFifoFd < 0) { | ||
| CSIFW_LOGE("open CSI_DUMP_DATA_QUEUE fail %d", errno); | ||
| close(gSockFd); | ||
| return CSIFW_ERROR; | ||
| } | ||
|
|
||
| if (pthread_create(&gThreadId, NULL, dataTransmitter, NULL) != 0) { | ||
| CSIFW_LOGE("Failed to create dataTransmitter thread %d", errno); | ||
| close(gSockFd); | ||
| close(gFifoFd); | ||
| return CSIFW_ERROR; | ||
| } | ||
|
|
||
| if (pthread_setname_np(gThreadId, "CSI_DataDumpOverNetwork") != 0) { | ||
| CSIFW_LOGE("Error in setting dataTransmitter thread name, error_no: %d", errno); | ||
| } | ||
| CSIFW_LOGI("CSI_DataDumpOverNetwork created"); | ||
| return CSIFW_OK; | ||
| } | ||
|
|
||
| CSIFW_RES csi_logs_dumper_deinit() | ||
| { | ||
| gListener = NULL; | ||
| close(gSockFd); | ||
| close(gFifoFd); | ||
| return CSIFW_OK; | ||
| } |
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
| Original file line number | Diff line number | Diff line change |
|---|---|---|
| @@ -0,0 +1,21 @@ | ||
| #ifndef __CSI_LOGS_DUMPER__ | ||
| #define __CSI_LOGS_DUMPER__ | ||
|
|
||
| #include "csifw.h" | ||
|
|
||
| #ifdef CONFIG_CSI_DATA_DUMP_OVER_NETWORK | ||
| #define CSI_DUMP_DATA_QUEUE_NAME "/dev/csidump_data" | ||
|
|
||
| typedef enum EVENT { | ||
| STOP_DUMP, | ||
| START_DUMP | ||
| } EVENT; | ||
|
|
||
| CSIFW_RES csi_logs_dumper_init(); | ||
| CSIFW_RES csi_logs_dumper_deinit(); | ||
|
|
||
| typedef void (*csiDataDumpListener)(EVENT event); | ||
| void set_event_listener(csiDataDumpListener listener); | ||
| #endif | ||
|
|
||
| #endif /* __CSI_LOGS_DUMPER__ */ |
This file contains bidirectional Unicode text that may be interpreted or compiled differently than what appears below. To review, open the file in an editor that reveals hidden Unicode characters.
Learn more about bidirectional Unicode characters
| Original file line number | Diff line number | Diff line change |
|---|---|---|
| @@ -0,0 +1,16 @@ | ||
| # How To Run csi_datadump_udp_client.c File | ||
|
|
||
| ## Steps: | ||
| ### 1. First compile the file: | ||
| ```bash | ||
| gcc -o program csi_datadump_udp_client.c -lpthread | ||
| ``` | ||
|
|
||
| ### 2. Run the program | ||
| Command Format: ./program <IP_ADDRESS> <PORT> | ||
| ```bash | ||
| ./program 192.168.1.120 5000 | ||
| ``` | ||
|
|
||
| ## How to STOP the datadump | ||
| #### Type *STOP* in terminal and press enter. |
Oops, something went wrong.