Search  

---

C:/temp/src/j2k/QNX4/SerialPort.cpp

Go to the documentation of this file.

#ifndef __J2K__SerialPort_CPP__
#define __J2K__SerialPort_CPP__

#include <j2k/Fred/QNX/SerialPort.hpp>

// Default Constructor
SerialPort::SerialPort() {
  // Elan-104 on QNX-2 COM1
  modem = open( "//2/dev/ser1", O_RDWR );
  Task  = new SerialTask_t[ MAX_SERIAL_TASK ];

  for( int i = 0; i < MAX_SERIAL_TASK; i++ ) {
    Task[i].cmd   = 0;
    Task[i].id    = 0;
    Task[i].valid = 0;
  }

  bottom  = 0;
  Waiting = 0;

  curr.cmd   = 0;
  curr.id    = 0;
  curr.valid = 0;

  TrainCmd( 96, -1 );   // Activate Serial Controller
}

// Destructor
SerialPort::~SerialPort() {
  delete [] Task;
  TrainCmd( 97, -1 );   // Deactivate Serial Controller
}

void SerialPort::TrainCmd( int cmd, int id ) {
  buf[0] = cmd;

  if ( id > 0 ) {
    buf[1] = id;
    write( modem, &buf, 2 );    // Send TrainID
  } else {
    write( modem, &buf, 1 );    // Don't Send TrainID
  }

  Waiting = 1;
  delay( MODEM_DELAY );

  Waiting = 0;
}

void SerialPort::AddTask( int cmd, int id ) {
  if ( Waiting == 0 ) {

    TrainCmd( cmd, id );

  } else if ( bottom >= MAX_SERIAL_TASK ) {

    printf("\n*** Error: Reach the end of the array  ***  ");
    printf("\n***        Can't Add more Serial Task ! ***\n"); 
    return;        

  } else {
    ++bottom;
    Task[ bottom ].cmd   = cmd;
    Task[ bottom ].id    = id;
    Task[ bottom ].valid = 1;
  }
}

void SerialPort::ExecuteTask() {
  if ( bottom < 1 ) return;
  if ( Task[0].valid == 0 ) return;

  curr.cmd = Task[0].cmd;
  curr.id  = Task[0].id;

  for( int k = 0; k < bottom; k++ ) {
    Task[k].cmd   = Task[k+1].cmd;
    Task[k].id    = Task[k+1].id;
    Task[k].valid = Task[k+1].valid;
  }

  Task[bottom].cmd   = 0;
  Task[bottom].id    = 0;
  Task[botton].valid = 0;

  bottom--;
  curr.valid = 0;
  TrainCmd( curr.cmd, curr.id );
}

#endif

---