Search  

---

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

Go to the documentation of this file.

/*
  Don't forget to put the Train Controller
  to ANALOG = OFF, put it back ON 
  if you want to manipulate it manually
*/

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

 UINT state;

 pid_t kb_proxy;
 pid_t mdm_proxy;
 pid_t pid;

 int  kb_fd;
 int  mdm_fd;
 int  n;
 char buf[3];

void TrainCmd( int cmd ) {
  buf[0] = cmd;
  write( mdm_fd, &buf, 1 );
  delay( 1000 );
}

void TrainCmd( int cmd, int id ) {
  buf[0] = cmd;
  buf[1] = id;
  write( mdm_fd, &buf, 2 );
  delay( 1000 );
}

int main() {
  kb_fd  = open( "/dev/con1",    O_RDWR );  // Local Keyboard
  mdm_fd = open( "//2/dev/ser1", 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_state( mdm_fd, 0, _DEV_EVENT_INPUT );
  dev_arm(   kb_fd,  kb_proxy,  _DEV_EVENT_INPUT );
  dev_arm(   mdm_fd, mdm_proxy, _DEV_EVENT_INPUT );

  pid = Receive( 0, 0, 0 );

  long function;
  printf("\nStart Pgm");
  TrainCmd( 96 );

  delay( 500 );

  printf("\nSpeed=9");
  TrainCmd( 9, 1 );

  delay( 500 );

  printf("\nReverse=15");
  TrainCmd( 15, 1 );

  delay( 500 );

  printf("\nSpeed=13");
  TrainCmd( 13, 1 );

  delay( 500 );

  printf("\nStop Train");
  TrainCmd( 0,  1 );

  delay( 500 );

  printf("\nStop Pgm");
  TrainCmd( 97 );

  return 0;
}

---