From 7a51b8103dc6b6a5ee4689dc93cad40b6e866d06 Mon Sep 17 00:00:00 2001 From: Florian Jung Date: Wed, 7 Jan 2015 13:10:33 +0100 Subject: client receives navdata --- client2.c | 21 +++++++++++++++++---- 1 file changed, 17 insertions(+), 4 deletions(-) (limited to 'client2.c') diff --git a/client2.c b/client2.c index 3304346..1e04755 100644 --- a/client2.c +++ b/client2.c @@ -34,6 +34,14 @@ int read_completely(int fd, void* buf, size_t len) int main(int argc, const char** argv) { struct sockaddr_un my_sockaddr; + struct navdata_t + { + double phi; + double theta; + double psi; + double batt; + }; + my_sockaddr.sun_family=AF_UNIX; strcpy(my_sockaddr.sun_path, SOCKETPATH); int sockaddrlen = strlen(my_sockaddr.sun_path) + sizeof(my_sockaddr.sun_family); @@ -52,8 +60,10 @@ int main(int argc, const char** argv) write(sockfd,"get\n",4); read_completely(sockfd, buffer, 4); int framelen = ((buffer[0]*256+buffer[1])*256+buffer[2])*256+buffer[3]; - if (framelen > sizeof(buffer)) suicide("buffer too small"); - read_completely(sockfd, buffer, framelen); + if (framelen + sizeof(navdata_t) > sizeof(buffer)) suicide("buffer too small"); + read_completely(sockfd, buffer, framelen+sizeof(navdata_t)); + const navdata_t* navdata = (navdata_t*)(buffer + framelen); + printf("%lf\t%lf\t%lf\t%lf\n", navdata->phi, navdata->theta, navdata->psi, navdata->batt); char key; bool go=true; bool new_vals=true; @@ -139,8 +149,11 @@ int main(int argc, const char** argv) write(sockfd,"get\n",4); read_completely(sockfd, buffer, 4); int framelen = ((buffer[0]*256+buffer[1])*256+buffer[2])*256+buffer[3]; - if (framelen > sizeof(buffer)) suicide("buffer too small"); - read_completely(sockfd, buffer, framelen); + if (framelen + sizeof(navdata_t) > sizeof(buffer)) suicide("buffer too small"); + read_completely(sockfd, buffer, framelen+sizeof(navdata_t)); + + const navdata_t* navdata = (navdata_t*)(buffer + framelen); + printf("%lf\t%lf\t%lf\t%lf\n", navdata->phi, navdata->theta, navdata->psi, navdata->batt); } //Mat dingens=Mat::eye(100,100,CV_8UC1) * 244; -- cgit v1.2.3