Search  

---

C:/temp/src/j2k/nto/bak2/BoardServer.cpp

Go to the documentation of this file.

#ifndef __J2K__BoardServer_CPP__
#define __J2K__BoardServer_CPP__

#include <stdio.h>
#include <string.h>
#include <inttypes.h>
#include <sys/mman.h>
#include <sys/neutrino.h>
#include <hw/inout.h>

#include "BoardDef.hpp"

uintptr_t setHardware( uint64_t addr ) 
{
  ThreadCtl( _NTO_TCTL_IO, 0 );
  uintptr_t ptr = mmap_device_io( 2, addr );
}

static uintptr_t       ib_state = NULL;
static uintptr_t       ob_state = NULL;
static uintptr_t       ib_ctrl  = NULL;
static uintptr_t       ob_ctrl  = NULL;
static name_attach_t*  attach   = (name_attach_t*)(~0);

static USHORT          ob_val = 0xFFFF;
static USHORT          ib_val = 0xFFFF;
static int             done   = 0;

void SetupIO() 
{
  ob_state = setHardware( BOARD_OUT16_ADDR );
  ib_state = setHardware( BOARD_IN16_ADDR  );
  ob_ctrl  = setHardware( BOARD_OUT16_ADDR + BOARD_CONTROL_OFFSET );
  ib_ctrl  = setHardware( BOARD_IN16_ADDR  + BOARD_CONTROL_OFFSET );

  out16( ob_state, ob_val );      // Set to default
  out8(  ob_ctrl,  BOARD_OUT16_ENABLE ); // Set Array 0 & 1 ON (Controllable)
  ib_val = in16( ib_state ); 
}

void CleanUp() 
{
  /* Remove the name from the space */
  printf( "Removing the attach name from the local name space.\n" );
  name_detach(attach, 0);
}

/*** Server Side of the code ***/
int server() 
{
    board_data_t msg, rmsg;
    int rcvid;

    /* Create a local name (/dev/name/local/...) */
    attach = name_attach( NULL, ATTACH_POINT, NAME_FLAG_ATTACH_GLOBAL );
    if ( attach == NULL )
    {
   printf( "Could not attach a name to the local name space.\n" );
        return EXIT_FAILURE;
    }

    SetupIO();

    /* Do your MsgReceive's here now with the chid */
    while( !done ) 
    {
        memset(  msg.string, 0, 80 );
        memset( rmsg.string, 0, 80 );
        rcvid = MsgReceive(attach->chid, &msg, sizeof(msg), NULL);

// printf( "Received [%d]\n", rcvid );

        if (rcvid == -1)   /* Error condition, exit */
        {
            break;
        }

        if (rcvid == 0)    /* Pulse received */
        {
       printf( "Pulse received.\n" );
            switch (msg.hdr.code) {
            case _PULSE_CODE_DISCONNECT:
                /*
                 * A client disconnected all its connections (called
                 * name_close() for each name_open() of our name) or
                 * terminated
                 */
      printf( "Client disconnected.\n" );
                fflush( stdout );
                ConnectDetach(msg.hdr.scoid);
                break;

            case _PULSE_CODE_UNBLOCK:
                /*
                 * REPLY blocked client wants to unblock (was hit by
                 * a signal or timed out).  It's up to you if you
                 * reply now or later.
                 */
      printf( "Client wants to unblock.\n");
                break;
            default:
                /* A pulse sent by one of your processes? */
      printf( "Unknown pulse.\n" );
                fflush( stdout );
                break;
            }
            continue;
        }

        /* A QNX IO message received, reject */
        if (msg.hdr.type >= _IO_BASE && msg.hdr.type <= _IO_MAX) {
            MsgError( rcvid, ENOSYS );
       printf( "Rejected.\n" );
            continue;
        }

        if ( msg.serialMsgID != BOARD_SerialMsgID ) {
     printf( "Wrong Serial ID...\n" );
     continue;
        }

        /* A message (presumable ours) received, handle */
//        printf( "Server receive %d \n", msg.data );

        memcpy( &rmsg, &msg, sizeof( msg ) );

   register UCHAR cmd = msg.command;

   if ( (cmd & BOARD_CONTROL_IN) == BOARD_CONTROL_IN )
     out8( ib_ctrl, msg.control_in );

   if ( (cmd & BOARD_CONTROL_OUT) == BOARD_CONTROL_OUT )
     out8( ob_ctrl, msg.control_out );

   if ( (cmd & BOARD_IN16_READ ) == BOARD_IN16_READ ) {
     ib_val = in16( ib_state );
     rmsg.input = ~ib_val;
   }
 
   if ( (cmd & BOARD_OUT16_WRITE ) == BOARD_OUT16_WRITE ) {
     ob_val = ~( msg.output );
     out16( ob_state, ob_val );
   }

   if ( (cmd & BOARD_GET_STATE) == BOARD_GET_STATE ) {
     rmsg.control_in  = in8( ib_ctrl );
     rmsg.control_out = in8( ib_ctrl );
     rmsg.output      = ~ob_val;
     // input processed already.
   }

   if ( (cmd & BOARD_TEST_SERVER) == BOARD_TEST_SERVER ) {
     memcpy( &rmsg, &msg, sizeof( board_data_t ) );
   }

   if ( (cmd & BOARD_KILL_SERVER) == BOARD_KILL_SERVER ) {
     done++;
   }

   rmsg.command = BOARD_REPLY_DONE;

        rmsg.data++;
        strcpy( rmsg.string, "ACK" );
        MsgReply(rcvid, EOK, &rmsg, sizeof( rmsg ) );
    }

    CleanUp();

    return EXIT_SUCCESS;
}

int main(int argc, char **argv) {
    return server();
}

#endif

---