Dependencies:   ros_lib_kinetic

Revision:
9:cd3607ba5643
Parent:
7:5b6a2cefbf3b
Child:
11:7029367a1840
--- a/HLComms.cpp	Tue Aug 07 09:18:15 2018 +0000
+++ b/HLComms.cpp	Tue Aug 07 14:15:37 2018 +0000
@@ -69,6 +69,7 @@
 
 
 void HLComms::close_server(void) {
+    printf("Closing server...\n\r");
     interfaces.clt_sock.close();
     interfaces.srv.close();
     interfaces.eth.disconnect();
@@ -76,7 +77,15 @@
 }
 
 
-msg_format HLComms::consume_message( unsigned char * msg ) { //HLComms::msg_format
+int HLComms::receive_message(void) {
+    memset(recv_buffer, 0, sizeof(recv_buffer));
+    int error_code = interfaces.clt_sock.recv(recv_buffer, 1024); // Blocks until data is received
+    return error_code;
+}
+
+
+msg_format HLComms::process_message(void) { //HLComms::msg_format
+    unsigned char * msg = recv_buffer;
     // Break message string into chunks at each comma
     vector<string> tokens;
     char * delim = ",";
@@ -115,4 +124,15 @@
     //throw std::invalid_argument( "received negative value" );
     //return 0;
     return input;
-} // End of consume_message()
\ No newline at end of file
+} // End of consume_message()
+
+void HLComms::make_message(double *dblTime) {
+    memset(send_buffer, 0, sizeof(send_buffer));
+    _snprintf(send_buffer,64,"%f",*dblTime);
+}
+
+int HLComms::send_message(void) {
+    char * msg = send_buffer;
+    int error_code = interfaces.clt_sock.send(msg, strlen(msg));
+    return error_code;
+}
\ No newline at end of file