/home/breidi/Dropbox/libtia/src/tia/tia_server.cpp

Go to the documentation of this file.

/*
    This file is part of the TOBI Interface A (TiA) library.

    Commercial Usage
    Licensees holding valid Graz University of Technology Commercial
    licenses may use this file in accordance with the Graz University
    of Technology Commercial License Agreement provided with the
    Software or, alternatively, in accordance with the terms contained in
    a written agreement between you and Graz University of Technology.

    --------------------------------------------------

    GNU Lesser General Public License Usage
    Alternatively, this file may be used under the terms of the GNU Lesser
    General Public License version 3.0 as published by the Free Software
    Foundation and appearing in the file lgpl.txt included in the
    packaging of this file.  Please review the following information to
    ensure the GNU General Public License version 3.0 requirements will be
    met: http://www.gnu.org/copyleft/lgpl.html.

    In case of GNU Lesser General Public License Usage ,the TiA library
    is distributed in the hope that it will be useful,
    but WITHOUT ANY WARRANTY; without even the implied warranty of
    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
    GNU General Public License for more details.

    You should have received a copy of the GNU Lesser General Public License
    along with the TiA library. If not, see <http://www.gnu.org/licenses/>.

    Copyright 2010 Graz University of Technology
    Contact: TiA@tobi-project.org
*/

// STL
#include <iostream>
#include <sstream>
#include <vector>
#include <algorithm>

// Boost
#include <boost/date_time/posix_time/posix_time.hpp>
#include <boost/lexical_cast.hpp>
#include <boost/bind.hpp>
#include <boost/asio.hpp>

// TICPP
#include "ticpp/ticpp.h"

// local
#include "tia/data_packet_interface.h"
#include "tia/tia_server.h"

#include "tia-private/network/control_connection_server.h"
#include "tia-private/network/tcp_data_server.h"
#include "tia-private/network/udp_data_server.h"
#include "tia-private/newtia/server_impl/tia_server_state_server_impl.h"
#include "tia-private/newtia/network_impl/boost_tcp_server_socket_impl.h"
#include "tia-private/newtia/server_impl/control_connection_server_2_impl.h"

#include "tia-private/newtia/server_impl/fusty_data_server_impl.h"
#include "tia-private/newtia/fusty_hardware_interface_impl.h"

#include "tia-private/datapacket/data_packet_impl.h"
#include "tia-private/datapacket/data_packet_3_impl.h"

#ifdef TIMING_TEST
  #include "LptTools/LptTools.h"
  #define LPT1  0
  #define LPT2  1
#endif

namespace tia
{
using boost::uint64_t;
using boost::uint32_t;
using boost::uint16_t;
using boost::int16_t;
using boost::int64_t;
using boost::lexical_cast;
using namespace std;

//-----------------------------------------------------------------------------

TiAServer::TiAServer(boost::asio::io_service& io_service, bool new_tia)
  : io_service_(io_service),
//  config_(0),
  tcp_data_server_(0),
  udp_data_server_(0),
  control_connection_server_(0),
  server_state_server_(0),
  new_tia_ (new_tia),
  control_connection_server_2_(0),
  data_server_(0), hardware_interface_(0)

{

  data_packet_impl_.reset( new DataPacketImpl );
  work_data_packet_impl_ = new DataPacketImpl;

  data_packet_3_impl_.reset( new DataPacket3Impl );
  work_data_packet_3_impl_ = new DataPacket3Impl;

  #ifdef TIMING_TEST
    timestamp_ = boost::posix_time::microsec_clock::local_time();
    counter_ = 0;
    t_max_last_ = boost::posix_time::time_duration (0, 0, 0);
    t_max_total_ = boost::posix_time::time_duration (0, 0, 0);
    t_min_last_ = boost::posix_time::time_duration (10, 0, 0);
    t_min_total_ = boost::posix_time::time_duration (10, 0, 0);
    t_var_ = 0;
    lpt_flag_ = 0;

      if(!LptDriverInstall())
      {
        cerr << "Installing LptTools lpt driver failed (do you have access rights for the lpt-port?)." << endl;
        throw std::runtime_error("Error installing LptTools lpt driver!");
      }

      if(!LptInit())
      {
        cerr << "Initializing lpt driver failed (do you have access rights for the lpt-port?)." << endl;
        throw std::runtime_error("Error initializing lpt driver!");
      }
  #endif
}

//-----------------------------------------------------------------------------

TiAServer::~TiAServer()
{
  if(tcp_data_server_)
    delete tcp_data_server_;

  if(udp_data_server_)
    delete udp_data_server_;

  if(control_connection_server_)
    delete control_connection_server_;

  if(control_connection_server_2_)
    delete control_connection_server_2_;

  if(server_state_server_)
    delete server_state_server_;

  if(data_server_)
    delete data_server_;

  if(hardware_interface_)
    delete hardware_interface_;

  data_packet_ = 0;
  if(work_data_packet_impl_)
    delete work_data_packet_impl_;
  if(work_data_packet_3_impl_)
    delete work_data_packet_3_impl_;

  #ifdef TIMING_TEST
    LptExit();
  #endif
}

//-----------------------------------------------------------------------------

void TiAServer::initialize(std::map<std::string,std::string>& subject_info_map,
                              std::map<std::string,std::string>& server_settings)
{
  server_settings_ = server_settings;

  createSubjectInfo(subject_info_map);
  createSignalInfo();

  uint16_t ctl_port = lexical_cast<uint16_t>(server_settings_[Constants::ss_ctl_port]);

  tcp_data_server_ = new TCPDataServer(io_service_);

  uint16_t udp_port = lexical_cast<uint16_t>(server_settings_[Constants::ss_udp_port]);
  udp_data_server_ = new UDPDataServer(io_service_);
  udp_data_server_->setDestination(server_settings_[Constants::ss_udp_bc_addr], udp_port);

  if (new_tia_)
  {
    hardware_interface_ = new tia::FustyHardwareInterfaceImpl(subject_info_, signal_info_);

    boost::shared_ptr<tia::TCPServerSocket>
        server_state_server_socket(new tia::BoostTCPServerSocketImpl (io_service_));
    server_state_server_ = new tia::TiAServerStateServerImpl(server_state_server_socket);

    data_server_ = new tia::FustyDataServerImpl(*tcp_data_server_, *udp_data_server_);


    boost::shared_ptr<tia::TCPServerSocket>
        control_connection_server2_socket(new tia::BoostTCPServerSocketImpl (io_service_));
    control_connection_server_2_ =
        new tia::ControlConnectionServer2Impl(control_connection_server2_socket, ctl_port,
                   data_server_, server_state_server_, hardware_interface_);

    data_packet_ = data_packet_3_impl_.get();
    work_data_packet_ = work_data_packet_3_impl_;
  }
  else
  {
    control_connection_server_ = new ControlConnectionServer(subject_info_map,
                                                             io_service_, *this);
    control_connection_server_->bind(ctl_port);
    control_connection_server_->listen();

    data_packet_ = data_packet_impl_.get();
    work_data_packet_ = work_data_packet_impl_;
  }
}

//-----------------------------------------------------------------------------

DataPacket* TiAServer::getEmptyDataPacket()
{
  return data_packet_;
}

//-----------------------------------------------------------------------------

DataPacketImpl  TiAServer::makeDataPacketCopy(DataPacketImpl& packet)
{
  DataPacketImpl p(packet);
  return p;
}

//-----------------------------------------------------------------------------

DataPacket3Impl  TiAServer::makeDataPacketCopy(DataPacket3Impl& packet)
{
  DataPacket3Impl p(packet);
  return p;
}

//-----------------------------------------------------------------------------

void TiAServer::sendDataPacket()
{
  if(new_tia_)
    *work_data_packet_3_impl_ = *(data_packet_3_impl_.get() );
  else
    *work_data_packet_impl_ = *(data_packet_impl_.get() );

  tcp_data_server_->sendDataPacket( *work_data_packet_ );
  udp_data_server_->sendDataPacket( *work_data_packet_ );

  work_data_packet_->reset();

  #ifdef TIMING_TEST
    timestamp_ = boost::posix_time::microsec_clock::local_time();
    int port_state = LptPortIn(LPT1,0);
    if(!lpt_flag_)
    {
      lpt_flag_ = 1;
      LptPortOut(LPT1, 0, port_state | 0x02);
    }
    else
    {
      lpt_flag_ = 0;
      LptPortOut(LPT1, 0, port_state & ~0x02);
    }
    counter_++;

    diff_ = timestamp_ - data_packet_->getTimestamp();
    t_diffs_.push_back (diff_);
    t_min_total_ = min (t_min_total_, diff_);
    t_max_total_ = max (t_max_total_, diff_);
    t_min_last_ = min (t_min_last_, diff_);
    t_max_last_ = max (t_max_last_, diff_);

    t_mean_ = (t_mean_ + diff_)/2;
    t_var_  = (t_var_ +
    ( (diff_.total_microseconds() - t_mean_.total_microseconds() )*
    (diff_.total_microseconds() - t_mean_.total_microseconds() )  ) )/2;

    if( (master_samplingrate_/master_blocksize_ < 1) ||
       (counter_%((master_samplingrate_/master_blocksize_) *2) == 0) )
    {
      sort (t_diffs_.begin(), t_diffs_.end());

      cout << "Packet Nr.: " << counter_ << ";  ";
      cout << "Timing (microsecs) -- mean: " << t_mean_.total_microseconds() << ", ";
      cout << "variance: " << t_var_;
      cout << ", min: " << t_min_last_.total_microseconds() << " (total: "<<  t_min_total_.total_microseconds() <<"), ";
      cout << "max: "<< t_max_last_.total_microseconds() << " (total: "<< t_max_total_.total_microseconds() << "), ";
      cout << "median: " << t_diffs_[t_diffs_.size() / 2].total_microseconds () << endl;
      t_diffs_.clear();
      t_min_last_ = boost::posix_time::time_duration (10, 0, 0);
      t_max_last_ = boost::posix_time::time_duration (0, 0, 0);
    }

  #endif

}

//-----------------------------------------------------------------------------

void TiAServer::createSubjectInfo(std::map<std::string,std::string> subject_map)
{
  subject_info_.setId(subject_map["id"]);
  subject_info_.setFirstName(subject_map["first_name"]);
  subject_info_.setSurname(subject_map["surname"]);
  subject_info_.setBirthday(subject_map["birthday"]);
  subject_info_.setMedication(subject_map["medication"]);

  std::string value = subject_map["sex"];
  if (value == "m")
    subject_info_.setSex(SubjectInfo::Male);
  else if (value == "f")
    subject_info_.setSex(SubjectInfo::Female);

  value = subject_map["handedness"];
  if (value == "r")
    subject_info_.setHandedness(SubjectInfo::RightHanded);
  else if (value == "l")
    subject_info_.setHandedness(SubjectInfo::LeftHanded);

  value = subject_map["glasses"];
  if (value == "y")
    subject_info_.setShortInfo(SubjectInfo::Glasses, SubjectInfo::Yes);
  else if (value == "n")
    subject_info_.setShortInfo(SubjectInfo::Glasses, SubjectInfo::No);
  else
    subject_info_.setShortInfo(SubjectInfo::Glasses, SubjectInfo::Unknown);

  value = subject_map["smoker"];
  if (value == "y")
    subject_info_.setShortInfo(SubjectInfo::Smoking, SubjectInfo::Yes);
  else if (value == "n")
    subject_info_.setShortInfo(SubjectInfo::Smoking, SubjectInfo::No);
  else
    subject_info_.setShortInfo(SubjectInfo::Smoking, SubjectInfo::Unknown);
}

//-----------------------------------------------------------------------------

void TiAServer::createSignalInfo()
{
  const std::vector<uint32_t>& sig_types       = sig_types_;
  const std::vector<uint16_t>& blocksizes      = blocksizes_;
  const std::vector<uint32_t>& fs_per_sig_type = fs_per_sig_type_;

  const std::map<uint32_t, std::vector<std::string> >& channel_map = channels_per_sig_type_;

  assert(sig_types.size() == blocksizes.size() && sig_types.size() == fs_per_sig_type.size());

  cout << endl;
  cout << " Sent Signal Types: (ordered)" << endl;

  for (vector<uint32_t>::size_type index = 0; index < sig_types.size(); ++index)
  {
    Signal signal;

    uint32_t sig_num_type = sig_types[index];
    std::string sig_str_type = Constants().getSignalName(sig_num_type);
    signal.setType(sig_str_type);
    cout << "   ... Signal type " << sig_str_type << endl;

    uint16_t block_size = blocksizes[index];
    signal.setBlockSize(block_size);

    uint32_t fs = fs_per_sig_type[index];
    signal.setSamplingRate(fs);

    std::map<uint32_t, std::vector<std::string> >::const_iterator it_channel_map =
      channel_map.find(sig_num_type);

    if (it_channel_map != channel_map.end())
    {
      const std::vector<std::string>& channel_names = (*it_channel_map).second;
      std::vector<std::string>::const_iterator it_channels = channel_names.begin();
      std::vector<std::string>::const_iterator end_channels = channel_names.end();
      for (; it_channels != end_channels; ++it_channels)
      {
        Channel channel;
        channel.setId(*it_channels);
        signal.channels().push_back(channel);
      }
    }

    signal_info_.signals().insert(make_pair(sig_str_type,signal));
  }

  signal_info_.setMasterBlockSize(master_blocksize_);
  signal_info_.setMasterSamplingRate(master_samplingrate_);
}

//-----------------------------------------------------------------------------


} // Namespace tobiss