Search  

---

C:/temp/src/j2k/QNX4/Train/Switch.cpp

Go to the documentation of this file.

#ifndef __J2K__Train__Switch_CPP__
#define __J2K__Train__Switch_CPP__

Switch::Switch()
{
  setSwitchID( 1 );
}

Switch::~Switch()
{
  close( Output );          // DEBUG: Close output port
}

void Switch::setSwitchID( int ID )
{
  SwitchID = ID;
  SwitchPosition = CLOSE;
  setSwitch( CLOSE );
}

void Switch::setSwitch( int P )
{
  SwitchPosition = P;
  outp(0x182,3);

  if ( SwitchPosition == CLOSE ) {

    switch( SwitchID ) {
      case 1: outp(0x180,0xFD); break;
      case 2: outp(0x180,0xFB); break;
      case 3: outp(0x180,0xEF); break;
      case 4: outp(0x180,0x7F); break;
    }

  } else {

     switch( SwitchID ) {
       case 1: outp( 0x180, 0xFE ); break;
       case 2: outp( 0x180, 0xF7 ); break;
       case 3: outp( 0x180, 0xDF ); break;
       case 4: outp( 0x180, 0xBF ); break;
     }
  }

  delay( 200 );
  outp( 0x180, 0xFF );
}

int Switch::getSwitch()
{
  return ( SwitchPosition == OPEN );
}

#endif

---