neurosky/src/neurosky.cpp

Go to the documentation of this file.

#include "plugin.h"
#include "neurosky.h"
#include "Array.h"

#define TIME_OUT 100
#define DISCONNECTION_WIN_TIME 2000

Array<Neurosky*> neuroskyList ;
Array<int> portList ;
extern void handleDataValueFunc( unsigned char extendedCodeLevel,
                                unsigned char code,
                                unsigned char valueLength,
                                const unsigned char *value,
                                void *customData ) ; 


//--- default constructor 
Neurosky::Neurosky() : Thread()
{
  neuroskyList.Add(this) ;
  THINKGEAR_initParser( &parser, PARSER_TYPE_PACKETS, handleDataValueFunc,this);
  serie = new LSerie() ;
  char buffer [33];
  itoa ((int)this,buffer,10);
  mMutex.create(buffer) ;
  // Run thread
  this->start() ;
  this->isrunning = true ;
  bStatus = false ;
}

void Neurosky::connect()
{ 
  // Use a timer to avoid lost connection
  DWORD firstTime = timeGetTime() ;
  while(isrunning && timeGetTime()-firstTime<DISCONNECTION_WIN_TIME) {}
  //wait(mMutex.getName().c_str(),2000) ;
  // NeuroSky Connection
  int cpt = 0 ;
  do
  {
    cpt++;
    if(STG_Connect(serie,cpt,TG_BAUD_9600, TG_STREAM_PACKETS )){bStatus = true ; PostMessage(HScol, NEUROSKY_CONNECTED_CB, (int)this,NULL);}
  } while(cpt!=9 && !bStatus && isrunning);
  
}
bool Neurosky::readDataByte()
{ 
  DWORD askTime = timeGetTime() ;
  unsigned char streamByteH[1]  ;
  serie->receiveData(1,streamByteH) ;
  THINKGEAR_parseByte( &parser, streamByteH[0]) ;
  DWORD responseTime = timeGetTime() - askTime ;
  if(responseTime>TIME_OUT) return false ;
  else
    return true ;
}
void Neurosky::disconnect()
{ 
  if(bStatus) PostMessage(HScol, NEUROSKY_DISCONNECTED_CB, (int)this,NULL);
  STG_Disconnect(serie) ;
  bStatus = false ;
}
void Neurosky::safeConnection()
{ 
  disconnect() ;
  connect() ;
}

void Neurosky::run() 
{
  try 
  {
    while(isrunning)
    {
      if(!bStatus) safeConnection() ;
      if(bStatus) 
      {
        if(!readDataByte()) safeConnection() ;
      }
    }
    disconnect() ;
  }
  catch(ThreadException ex) 
  {
    MMechostr(MSKDEBUG,"error thread : %s \n",ex.getMessage().c_str()) ;
  }             
}


Neurosky::~Neurosky()
{
  this->isrunning = false ;
  this->bStatus = false ;
  this->stop() ;
  mMutex.release() ;
  neuroskyList.Delete(this) ;
  delete serie ;
}

---