X-Git-Url: https://gerrit.o-ran-sc.org/r/gitweb?p=sim%2Fe2-interface.git;a=blobdiff_plain;f=e2sim%2Fe2apv1sim%2Fricsim%2Ftest%2FPendulum%2Fe2sim_closedloop.c;fp=e2sim%2Fe2apv1sim%2Fricsim%2Ftest%2FPendulum%2Fe2sim_closedloop.c;h=613ce57b5d13e5be276a2c67bdc4656cf320547a;hp=0000000000000000000000000000000000000000;hb=3ebf932d23dcbec9ed19f4a51f9d00a0a54f5124;hpb=6896318f2b4ff01b4a88b16019c3dc93b0b693f5

diff --git a/e2sim/e2apv1sim/ricsim/test/Pendulum/e2sim_closedloop.c b/e2sim/e2apv1sim/ricsim/test/Pendulum/e2sim_closedloop.c
new file mode 100644
index 0000000..613ce57
--- /dev/null
+++ b/e2sim/e2apv1sim/ricsim/test/Pendulum/e2sim_closedloop.c
@@ -0,0 +1,263 @@
+/*
+ *
+ * Copyright 2019 AT&T Intellectual Property
+ * Copyright 2019 Nokia
+ *
+ * Licensed under the Apache License, Version 2.0 (the "License");
+ * you may not use this file except in compliance with the License.
+ * You may obtain a copy of the License at
+ *
+ *      http://www.apache.org/licenses/LICENSE-2.0
+ *
+ * Unless required by applicable law or agreed to in writing, software
+ * distributed under the License is distributed on an "AS IS" BASIS,
+ * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
+ * See the License for the specific language governing permissions and
+ * limitations under the License.
+ *
+ */
+
+
+#include <stdio.h>
+#include <stdlib.h>
+#include <time.h>
+#include <string.h>
+#include <assert.h>
+#include <unistd.h>             //for close()
+#include <arpa/inet.h>  //for inet_ntop()
+
+#include "e2sim_defs.h"
+#include "e2sim_sctp.h"
+#include "x2ap_message_handler.h"
+
+//OSN 2019
+#include "Pendulum_asn_codec.h"
+#include "adruino_serial.h"
+
+//rmr
+#include <errno.h>
+#include <sys/epoll.h>
+#include <rmr/rmr.h>
+#include "rmr_wrapper.h"
+
+static void pendulum_control_E2_agent(int client_fd)
+{
+ fprintf(stderr, "--------------------------------------\n");
+ fprintf(stderr, "E2 AGENT - START PENDULUM CONTROL\n");
+ fprintf(stderr, "--------------------------------------\n");
+
+ uint8_t   *buffer;
+ uint32_t  len;
+ clock_t   begin;
+ double    rtt; //ms
+
+ uint8_t recv_buf[MAX_SCTP_BUFFER];
+ int     recv_len;
+
+ double angle;
+ double torque;
+ long   sqn;
+ int    count = 0;
+
+ //serial
+ // int serial_fd;
+ char serial_buffer[MAX_SERIAL_BUFFER];
+ // serial_fd = start_serial_inferface(DEFAULT_BAUDRATE, DEFAULT_SERIAL_PORT);
+ //
+ // char *delay_str_prev = "$0#\n";
+ // //char *delay_str_new;
+ //
+ // int MSG_NUM = 10;
+ //
+ // //Always start with 0 delay
+ // serialport_write(serial_fd, "$0#\n");
+
+ // for(int i = 0; i < MSG_NUM; i++)
+ while(1)
+ {
+
+   fprintf(stderr, "----------------\n");
+   count += 1;
+   buffer  = NULL;
+   len     = 0;
+
+   // //1.Read from serial
+   // serial_readline(serial_fd, serial_buffer, MAX_SERIAL_BUFFER);
+   // if(serial_buffer[0] == '\n')
+   // {
+   //   //fprintf(stderr, "RECEIVED EOL\n");
+   //   continue;
+   // }
+   // //fprintf(stderr, "[Adruino] %s", serial_buffer);
+   usleep(5*1000);
+
+   snprintf(serial_buffer, sizeof(serial_buffer)-1, "E2 AGENT PING");
+
+   begin = clock();
+
+   //2. Encode pendulum angle to ASN1 message
+
+   len = pendulum_create_asn_msg(&buffer, 0, 0, 0, serial_buffer);
+
+   //3. Send ASN1 message to socket
+   if(sctp_send_to_socket(client_fd, buffer, (size_t)len) > 0){
+     fprintf(stderr, "Sent ASN1 message to E2 Termination\n");
+   }
+
+   // 4. Receive response from E2 Termination
+   memset(recv_buf, 0, sizeof(recv_buf));
+   recv_len = 0;
+   recv_len = recv(client_fd, &recv_buf, sizeof(recv_buf), 0);
+   if(recv_len == -1)
+   {
+     perror("recv()");
+     return;
+   }
+
+   char *recv_str;
+   recv_str = pendulum_get_strval(recv_buf, recv_len);
+   fprintf(stderr, "Received response message #%d from xApp: %s\n", count, recv_str);
+
+   // 5. TODO: Send response to serial
+   // Compare if delay has changed:
+   // if(strcmp(delay_str_prev, recv_str) != 0) {
+   //   serial_writeline(serial_fd, recv_str);
+   // }
+
+   //serial_writeline(serial_fd, recv_str);
+
+   //Write to a file
+   FILE *f;
+   f = fopen("arduino_delay.txt", "w");
+   fprintf(f, "%s", recv_str);
+   fclose(f);
+
+   begin = clock() - begin;
+   rtt = 1000*((double)begin)/CLOCKS_PER_SEC; // in ms
+   fprintf(stderr, "E2Agent-RIC-E2Agent RTT = %f ms\n", rtt);
+
+ }
+
+ close(client_fd);
+}
+
+int main(int argc, char *argv[])
+{
+ fprintf(stderr, "E2 AGENT - PENDULUM CONTROL. Version %s\n", VERSION);
+
+ // char *recv_str = "9";
+ // int delay;
+ //
+ // printf("delay = %d\n", atoi(recv_str));
+ //
+ // long delay = 22.5;
+ //
+ // printf("delay = %d\n", (int)delay);
+ // return 0;
+
+ // test_rmr(); return 0;
+ // test_adruino_serial(); return 0;
+
+ char* server_ip         = DEFAULT_SCTP_IP;
+ int server_port         = X2AP_SCTP_PORT;
+
+ int             server_fd;
+ int             client_fd;
+ struct sockaddr client_addr;
+ socklen_t       client_addr_size;
+
+ //read input
+ if(argc == 3) //user provided IP and PORT
+ {
+   server_ip = argv[1];
+   server_port = atoi(argv[2]);
+   if(server_port < 1 || server_port > 65535) {
+     fprintf(stderr, "Invalid port number (%d). Valid values are between 1 and 65535.\n"            , server_port);
+     return -1;
+   }
+ }
+ else if(argc == 2) //user provided only IP
+ {
+   server_ip = argv[1];
+ }
+ else if(argc == 1)
+ {
+   server_ip = DEFAULT_SCTP_IP;
+ }
+ else
+ {
+   fprintf(stderr, "Unrecognized option.\n");
+   fprintf(stderr, "Usage: %s [SERVER IP ADDRESS] [SERVER PORT]\n", argv[0]);
+   return -1;
+ }
+
+ server_fd = sctp_start_server(server_ip, server_port);
+
+ fprintf(stderr, "Waiting for connection...\n");
+ client_fd = accept(server_fd, &client_addr, &client_addr_size);
+ if(client_fd == -1){
+   perror("accept()");
+   close(client_fd);
+   return -1;
+ }
+
+ //Todo: retrieve client ip addr
+ struct sockaddr_in* client_ipv4 = (struct sockaddr_in*)&client_addr;
+ char client_ip_addr[INET_ADDRSTRLEN];
+ inet_ntop(AF_INET, &(client_ipv4->sin_addr), client_ip_addr, INET_ADDRSTRLEN);
+
+ fprintf(stderr, "New client connected from %s\n", client_ip_addr);
+
+ // while(1) //put while loop if want to receive from multiple clients
+ // {
+   uint8_t recv_buf[MAX_SCTP_BUFFER];
+   int     recv_len = 0;
+
+   memset(recv_buf, 0, sizeof(recv_buf));
+
+   fprintf(stderr, "------------------------\n");
+   recv_len = recv(client_fd, &recv_buf, sizeof(recv_buf), 0);
+   if(recv_len == -1)
+   {
+     perror("recv()");
+     return -1;
+   }
+   else if(recv_len == 0)
+   {
+     fprintf(stderr, "\nConnection from %s closed by remote peer\n", client_ip_addr);
+     if(close(client_fd) == -1)
+     {
+       perror("close");
+     }
+     return -1;
+   }
+
+   //fprintf(stderr, "Received a message of size %d\n", recv_len);
+
+   //TODO: check PPID here before calling x2ap handler
+
+   sctp_data_t response = {NULL, 0};
+   x2ap_eNB_handle_message(recv_buf, recv_len, &response);
+
+   //=======================================================================
+   //reply to client
+   assert(response.data != NULL);
+   if(sctp_send_to_socket(client_fd, response.data, (size_t)response.len) > 0){
+     fprintf(stderr, "Sent X2 SETUP RESPONSE \n");
+   } else{
+     perror("send to socket");
+     return -1;
+   }
+
+   fprintf(stderr, "X2 Setup Completed \n");
+
+   //=========================================================================
+   // Pendulum interaction
+   // Send pendulum state to E2 Termination and receive response
+   pendulum_control_E2_agent(client_fd);
+ // } //end while
+
+ close(client_fd);
+
+ return 0;
+}