added rotation coords

This commit is contained in:
Michal Starski 2018-11-20 13:42:43 +01:00
parent 0abf90a7e6
commit 401db23ba2
2 changed files with 81 additions and 61 deletions

BIN
server Executable file

Binary file not shown.

View File

@ -1,6 +1,3 @@
#pragma GCC diagnostic ignored "-Wunused-but-set-variable"
#pragma GCC diagnostic ignored "-Wunused-variable"
#include <stdio.h>
#include <string.h>
#include <netinet/in.h>
@ -11,21 +8,28 @@
#include <pthread.h>
#include <unistd.h>
typedef struct {
typedef struct
{
int socket;
struct sockaddr_in address;
} TData;
typedef struct {
typedef struct
{
float x;
float y;
float z;
float rot_x;
float rot_y;
float rot_z;
float rot_w;
} TFloat;
void Error(int err);
void *dataProcessHandler(void *data);
int main( void ) {
int main(void)
{
int e = 0;
int i = 0;
@ -53,28 +57,33 @@ int main( void ) {
myAddrForClients[0].sin_addr.s_addr = INADDR_ANY;
myAddrForClients[1].sin_addr.s_addr = INADDR_ANY;
for( i = 0; i < 2; i ++ ) {
if( (sock[i] = socket(AF_INET, SOCK_DGRAM, 0)) < 0 ) {
for (i = 0; i < 2; i++)
{
if ((sock[i] = socket(AF_INET, SOCK_DGRAM, 0)) < 0)
{
Error(e++);
return -1;
}
while( bind( sock[i], (struct sockaddr*)&myAddrForClients[i], sizeof( struct sockaddr_in) ) < 0 ) {
while (bind(sock[i], (struct sockaddr *)&myAddrForClients[i], sizeof(struct sockaddr_in)) < 0)
{
myAddrForClients[i].sin_port = htons(ntohs(myAddrForClients[i].sin_port) + 1);
}
}
if( (sockMain = socket(AF_INET, SOCK_DGRAM, 0)) < 0 ) {
if ((sockMain = socket(AF_INET, SOCK_DGRAM, 0)) < 0)
{
Error(e++);
return -1;
}
if( bind( sockMain, (struct sockaddr*)&myAddr, sizeof(struct sockaddr_in) ) < 0 ) {
if (bind(sockMain, (struct sockaddr *)&myAddr, sizeof(struct sockaddr_in)) < 0)
{
Error(e++);
return -1;
}
printf("Server running on port 8080\n");
addrLen = sizeof(struct sockaddr_in);
@ -84,17 +93,20 @@ int main( void ) {
char buf[5];
memset(buf, 0, sizeof(buf));
while( flag ) {
while (flag)
{
recvLen = recvfrom(sockMain, buf, 5, 0, (struct sockaddr *)&tmp, &addrLen);
if( buf[0] != 'U' || buf[1] != 'N' || buf[2] != 'I' || buf[3] != 'T' || buf[4] != 'Y' ) {
if (buf[0] != 'U' || buf[1] != 'N' || buf[2] != 'I' || buf[3] != 'T' || buf[4] != 'Y')
{
Error(e++);
return -1;
}
clients[2 - flag--] = tmp;
}
for( i = 0; i < (sizeof(myAddrForClients) / sizeof(myAddrForClients[0])); i++ ) {
for (i = 0; i < (sizeof(myAddrForClients) / sizeof(myAddrForClients[0])); i++)
{
char port2char[8];
sprintf(port2char, "%d\r\n", ntohs(myAddrForClients[i].sin_port));
@ -110,20 +122,25 @@ int main( void ) {
int size = (sizeof(handlers) / sizeof(handlers[0]));
for( i = 0; i < size; i++ ) {
for (i = 0; i < size; i++)
{
data[i].socket = sock[i];
data[i].address = clients[size - 1 - i];
}
for( i = 0; i < size; i++ ) {
if( pthread_create(&handlers[i], NULL, dataProcessHandler, &data[i] ) ) {
for (i = 0; i < size; i++)
{
if (pthread_create(&handlers[i], NULL, dataProcessHandler, &data[i]))
{
Error(e++);
return -1;
}
}
for( i = 0; i < size; i++ ) {
if( pthread_join( handlers[i], NULL )) {
for (i = 0; i < size; i++)
{
if (pthread_join(handlers[i], NULL))
{
Error(e++);
return -1;
}
@ -136,7 +153,8 @@ int main( void ) {
return 0;
}
void* dataProcessHandler( void * data ) {
void *dataProcessHandler(void *data)
{
TData *info = (TData *)data;
@ -149,14 +167,16 @@ void* dataProcessHandler( void * data ) {
printf("HANDLER STARTED..\n");
printf("LOOKING AT SOCKET: %d, ON PORT: %d\n", info->socket, ntohs(info->address.sin_port));
while( 1 ) {
if( recvfrom( info->socket, &floats, 12, 0, (struct sockaddr*)&tmp, &addrLen) != 12 ) continue;
while (1)
{
if (recvfrom(info->socket, &floats, 12, 0, (struct sockaddr *)&tmp, &addrLen) != 12)
continue;
sendto(info->socket, &floats, 12, 0, (struct sockaddr *)&info->address, sizeof(info->address));
}
return NULL;
}
void Error( int err ) {
void Error(int err)
{
printf("Error! Code: %d\n", err);
}