owlps/owlps-positioning/src/outputudpsocket.cc

#include "outputudpsocket.hh"
#include "request.hh"

#include <sstream>
#include <iostream>

#define PORT 9910

using namespace std ;

struct hostent *hostInfo ;
struct sockaddr_in serverAddress ;



/* *** Constructors *** */


OutputUDPSocket::OutputUDPSocket(const string &_remote_ip):
  remote_ip(_remote_ip)
{
  init_socket() ;
}


OutputUDPSocket::~OutputUDPSocket()
{
  kill_socket() ;
}



/* *** Operations *** */


void OutputUDPSocket::write(const Result &result)
{
  string timestampXYZ;
  ostringstream os;
  const Request *const request = result.get_request() ;

  Point3D position = result.get_position() ;

  os
      << request->get_time_sent() << ';'
      << position.get_x() << ';'
      << position.get_y() << ';'
      << position.get_z() ;
  timestampXYZ = os.str() ;

  cout << timestampXYZ << '\n' ;
  send_data(timestampXYZ);
}


void OutputUDPSocket::init_socket()
{
  cout << "Initialisation socket..." << endl;
  hostInfo = gethostbyname(remote_ip.c_str());
  serverPort = PORT;
  socketDescriptor = socket(AF_INET, SOCK_DGRAM, 0);
  serverAddress.sin_family = hostInfo->h_addrtype;
  memcpy((char *) &serverAddress.sin_addr.s_addr,
         hostInfo->h_addr_list[0], hostInfo->h_length);
  serverAddress.sin_port = htons(serverPort);
}


void OutputUDPSocket::send_data(string data)
{
  if (sendto(socketDescriptor, data.c_str(), data.size(), 0,
             (struct sockaddr *) &serverAddress,
             sizeof(serverAddress)) < 0)
    {
      cerr << "Émission du message impossible\n";
      close(socketDescriptor);
    }
}


void OutputUDPSocket::kill_socket()
{
  cout << "Fermeture de la socket..." << endl;
  close(socketDescriptor);
}