/cygdrive/d/src/svn/vrut/trunk/modules/tracking/backup/tracking.cpp

Go to the documentation of this file.

/*
 * $Id: tracking.cpp 324 2008-10-01 18:04:45Z kybav1 $
 *
 * Description  : Description
 * Author       : Radek Bien <mail Radek.Bien@seznam.cz>  <ICQ: 201-963-660>
 *
 * Purpose      :
 *     Long description of what the file is for.
 */


#include "tracking.h"
//#include "../../core/src/common.h"
//#include <wx/stopwatch.h>
using namespace VRUT;

Tracking::Tracking(const VRUT::MODULE_ID &_id, const wxString &_name, VRUT::EventHandler *msgSink)
: Module(_id, _name, 0, msgSink),
  localPortParamID(_name, wxT("localPort"), _id),
  packetTimeoutParamID(_name, wxT("packetTimeout"), _id),
  bufferSizeParamID(_name, wxT("bufferSize"), _id),
  translationFilterParamID(_name, wxT("translationFilter"), _id),
  rotationFilterParamID(_name, wxT("rotationFilter"), _id),
  bodyIDParamID(_name, wxT("bodyID"), _id),
  bodyTypeParamID(_name, wxT("bodyType"), _id),
  dumpTableParamID(_name, wxT("dumpTable"), _id),
  updateTableParamID(_name, wxT("updateTabe"), _id),
  IDoffsetParamID(_name, wxT("IDoffset"), _id)
{
       REGISTER_PARAM_GUI_TEXTCONTROL(bodyIDParamID, wxT("0"));
       REGISTER_PARAM_GUI_TEXTCONTROL(bodyTypeParamID, wxT("0"));
       REGISTER_PARAM_GUI_TEXTCONTROL(rotationFilterParamID, wxT("0.1"));
       REGISTER_PARAM_GUI_TEXTCONTROL(translationFilterParamID, wxT("5.0"));
       REGISTER_PARAM_GUI_BUTTON(updateTableParamID);
       REGISTER_PARAM_GUI_BUTTON(dumpTableParamID);
       REGISTER_PARAM_GUI_TEXTCONTROL(IDoffsetParamID,wxT("0"));
       REGISTER_PARAM_GUI_TEXTCONTROL(localPortParamID, wxT("2627"));
       REGISTER_PARAM_GUI_TEXTCONTROL(bufferSizeParamID, wxT("8192"));
       REGISTER_PARAM_GUI_TEXTCONTROL(packetTimeoutParamID, wxT("20"));
       IDoffset = 0;
       rotationFilter = (float)0.1;
       bodyType = bodyID = 0;
       translationFilter = 5;
       remoteAddress = wxT("localhost");
       remotePort = 2627;
       localPort = 2627;
       eventTimeout= packetTimeout = 20;
       listener = new Receiver();
       parser.SetQueue(&bodyQueue);
}

void Tracking::processEvent(wxCommandEvent & evt)
{
       Module::processEvent(evt);
       switch (evt.GetEventType())
       {
              case Event::EVT_PARAM_SET:
                     {
                            updateTable = dumpTable = 0;
                            UPDATE_PARAM_FROM_EVENT_INT(localPortParamID, localPort, evt);
                            UPDATE_PARAM_FROM_EVENT_INT(bufferSizeParamID, bufferSize, evt);
                            UPDATE_PARAM_FROM_EVENT_UNSIGNED(packetTimeoutParamID, packetTimeout,evt);
                            UPDATE_PARAM_FROM_EVENT_FLOAT(rotationFilterParamID, rotationFilter, evt);
                            UPDATE_PARAM_FROM_EVENT_FLOAT(translationFilterParamID, translationFilter, evt);
                            UPDATE_PARAM_FROM_EVENT_INT(bodyIDParamID, bodyID, evt);
                            UPDATE_PARAM_FROM_EVENT_INT(bodyTypeParamID, bodyType,evt);
                            UPDATE_PARAM_FROM_EVENT_INT(updateTableParamID, updateTable, evt);
                            UPDATE_PARAM_FROM_EVENT_INT(dumpTableParamID, dumpTable, evt);
                            UPDATE_PARAM_FROM_EVENT_INT(IDoffsetParamID, IDoffset, evt);
                            listener->UpdateSocket(remoteAddress, remotePort, localPort);
                            listener->ResizeBuffer(bufferSize);
                            eventTimeout = packetTimeout;
                            if (updateTable != 0)
                            {
                                   if(filter.UpdateFilter((Body::BodyType)bodyType, bodyID, rotationFilter, translationFilter))
                                   {
                                          LOG(wxT("<Tracking> Filter updated."));
                                   }
                                   else
                                   {
                                          LOG(wxT("<Tracking> Selected entry were not found! Entry Pre-created: "));
                                          this->dumpFilterTable();
                                   }
                            }
                            if (dumpTable != 0)
                            {
                                   this->dumpFilterTable();
                            }
                            break;
                     }
       }
       if (packetTimeout != eventTimeout) packetTimeout = eventTimeout;
}
void Tracking::run()
{
       while (listener->Receive())
       {
              parser.SetPacket(listener->GetPacket());
              if (parser.Parse())
              {
                     processQueue();
              }
              else
              {
                     LOGWARNING(wxT("<Tracking> Parsing Failed"));
                     safeEmptyQueue();
              }
       }
}
wxString Tracking::GetDesc() const
{
       return wxT("DTrack datagram receiver and parser");
}
Tracking::~Tracking()
{
       listener->~Receiver();
}
void Tracking::safeEmptyQueue()
{
       while (!bodyQueue.empty())
       {
              Body * tempB = bodyQueue.front();
              bodyQueue.pop();
              delete tempB;
       }
}
void Tracking::processQueue()
{
       while (!bodyQueue.empty())
       {
              Body * tempA = bodyQueue.front();
              bodyQueue.pop();
              if (filter.Filter(tempA))
              {
              //     LOG(wxT("<Tracking> Filtered packet"));
              }
              else
              {
              //     LOG(wxT("<Tracking> NOT filtered packet"));
                     DeviceData * data = new DeviceData;
                     data->id       = tempA->GetID() + IDoffset;
                     data->type     = tempA->GetType();
                     data->matrix   = tempA->Matrix();
                     data->buttons  = tempA->ButtonsMask32();
                     data->control1 = tempA->Control(0);
                     data->control1 = tempA->Control(1);
                     if (data->control1  < -1 || data->control1 > 1) data->control1 = 0;
                     if (data->control2  < -1 || data->control2 > 1) data->control2 = 0;

                     wxCommandEvent evt = Event::GET_EVT_INPUT_TRACKING(data);
                     PostToKernel(evt);
              }
              delete tempA;
       }
}
void Tracking::dumpFilterTable()
{

       wxString dump = wxT("<Tracking> FilterTable:\nType\tID\tAngleFilter\tDistFilter\n");
       dump += filter.GetAsString("\n","\t");
       LOG(dump);
}

---