Search  

---

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

Go to the documentation of this file.

#include <j2k/Fred/Basic.hpp>
#include <j2k/Fred/QNX/System.hpp>

#define   INPUT_BASE_ADDR    0x188 
#define   OUTPUT_BASE_ADDR   0x180 
#define   ENABLE_OFFSET      2 
#define   VAL_MAX            0xFF    // 255 (%1111 1111)

#define   LOCAL_KEYBOARD   "/dev/con1"
#define   ELAN104_SERIAL  "//2/dev/ser1"

/**********************************************************
 * Basic_Thread should have a  ' virtual Run() = 0; '
 * function that is implemented here.
 * The keyboard is used here to DEBUG and TEST
 * it should be replace by a message call from 
 * your application that sends the proper bytes, 
 * so it make sense.
 **********************************************************/      

class Board   // : public Basic_Thread
{
private:
   // In16 and Out16 Stuff
   int input_base_addr;
   int output_base_addr;
   int enable_addr;

   // Serial Port Stuff
   unsigned state;
   pid_t kb_proxy, mdm_proxy, pid;
   int kb_fd, mdm_fd, n;
   char buf[80];

public:
    Board( int in_addr  = INPUT_BASE_ADDR, int out_addr  = OUTPUT_BASE_ADDR )
    {
      // Initialize variables for In16 and Out16
      input_base_addr  = in_addr;
      output_base_addr = out_addr;
      enable_addr     = out_addr + ENABLE_OFFSET;

      outp( enable_addr, 3 );   // Enable Output Port 0 & 1 (%0000 0011)


      // Initialize and setup the Serial Port

      kb_fd  = open( LOCAL_KEYBOARD, O_RDWR );  // Local Keyboard
      mdm_fd = open( ELAN104_SERIAL, O_RDWR );  // QNX-2 Elan104 Board

      kb_proxy  = qnx_proxy_attach( 0, 0, 0, -1 );
      mdm_proxy = qnx_proxy_attach( 0, 0, 0, -1 );

      dev_mode( kb_fd,  0, _DEV_MODES );
      dev_mode( mdm_fd, 0, _DEV_MODES );

      // Clear, then arm the proxies for future events

      dev_state( kb_fd,  0, _DEV_EVENT_INPUT );
      dev_arm(   kb_fd,  kb_proxy,  _DEV_EVENT_INPUT );
      
      dev_state( mdm_fd, 0, _DEV_EVENT_INPUT );
      dev_arm(   mdm_fd, mdm_proxy, _DEV_EVENT_INPUT );
    }
    
    ~Board()
    {
      outp( output_base_addr, 0 );    // Send 0x00 to Port 0 & 1
      outp( output_base_addr + 1, 0 );
      outp( enable_addr, 0 );         // Disable All Output Port  
    }

    void Write( int port, int val)
    {
      port = ( port >= 1 ) ? ( 1 ) : ( 0 );
       val  = ( val > VAL_MAX ) ? ( VAL_MAX ) : ( val );

        outp( output_base_addr + port, val);
    }
   
   void Write( int val )
   {
      int port = ( val > VAL_MAX ) ? ( 1 ) : ( 0 );
          val  = ( val > VAL_MAX ) ? ( val % VAL_MAX ) : ( val );

       outp( output_base_addr + port, val);
   }

    int Read( int port )
    {
      port = ( port >= 1 ) ? ( 1 ) : ( 0 );

        return ( inp( input_base_addr + port ) );
    }

    int Read()
    {
      int r1 = inp( input_base_addr     );
      int r2 = inp( input_base_addr + 1 );

        return ( ( r2 << 8 ) + r1 );   // Shift Left 8 bits and Add.
    }

   // This is a bidirectionnal CHAT program 
   // between the ELAN104 and the HP Dump Terminal
   void Run()  
   {
      for(;;) {   // Infinite Loop, until CTRL-BREAK
      
         // Wait for either keyboard or modem to send an input.
         pid = Receive( 0, 0, 0 ); 
      
         // Waiting for an event, then check the Process ID,
         // Read the message and send it back to the other machine.
      
         if ( pid == kb_proxy ) {
      
            state = dev_state( kb_fd, 0, _DEV_EVENT_INPUT );
   
            // If there is an Input from Keyboard Console
            // then Read it and Send it Back to the Modem
      
            if ( state & _DEV_EVENT_INPUT ) {
               n = read( kb_fd, &buf, sizeof( buf ) );
               write( mdm_fd, &buf, n );
               dev_arm( kb_fd, kb_proxy, _DEV_EVENT_INPUT );
            }
      
         } else if ( pid == mdm_proxy ) {

            state = dev_state( mdm_fd, 0, _DEV_EVENT_INPUT );
   
      
            // If there is an Input from Modem
            // then Read it and Send it Back to the Keyboard Console
         
            if ( state & _DEV_EVENT_INPUT ) {
               n = read( mdm_fd, &buf, sizeof( buf ) );
               write( kb_fd, &buf, n );
               dev_arm( mdm_fd, mdm_proxy, _DEV_EVENT_INPUT );
            }
      
         }
      }
   }

}; 

int main() {
  Board* b = new Board();
  printf("READ()      [%d] \n\r", b->Read()     );
  printf("READ(0)     [%d] \n\r", b->Read(0)    );
  printf("READ(1)     [%d] \n\r", b->Read(1)    );
  printf("READ(5555)  [%d] \n\r", b->Read(5555) );

  b->Write( 0 );
  b->Write( 10 );
  b->Write( 255 );
  b->Write( 0xA5 );
  b->Write( 511 );
  b->Write( 12120 );
  b->Write( 0x1A0 );

  printf("\n\rBasic QNX Serial Port CHAT program: \n\r\n\n");
  b->Run();

  printf("\nDone!\n");

  delete b;

  return 0;
}

---