sw/dumprest/original/comm.c

   1
   2 #ifdef PC
   3 PORT port_handle;
   4
   5
   6 void (interrupt EN_FAR *(old_vect23))(void);
   7 void (interrupt EN_FAR *(old_vect1b))(void);
   8
   9 /* Trap break etc to allow program to terminate  on PC */
  10 void interrupt EN_FAR en_ctrl_brk()
  11 {
  12    terminate = 1;
  13 }
  14 void interrupt EN_FAR en_ctrl_c() {
  15    terminate =  1;
  16 }
  17
  18 int ser_read(int fd,char *buf,int bufsize)
  19 {
  20    int bufcnt = 0;
  21    int t;
  22
  23    t = com_getc(&port_handle);
  24    while (t != -1 && bufcnt < bufsize) {
  25       *(buf++) = t;
  26       t = com_getc(&port_handle);
  27       bufcnt++;
  28    }
  29    return bufcnt;
  30 }
  31
  32 int ser_write(int fd,char *buf,int bufsize)
  33 {
  34    int bufcnt = bufsize;
  35
  36    while (bufsize-- > 0) {
  37       while (com_putc(*buf,&port_handle) != 0);
  38       buf++;
  39    }
  40    return bufcnt;
  41 }
  42
  43 void cleanup(void)
  44 {
  45    while (!terminate && port_handle.tx_cnt != 0)
  46       ;
  47    if (terminate)
  48       com_clear_que(RX | TX, &port_handle);
  49    suspend(50);
  50    printf("Parity err %d framing err %d overrun err %d dropped %d\n",
  51       port_handle.parity_errs,port_handle.framing_errs,
  52       port_handle.overrun_errs,port_handle.rx_overflow);
  53    com_port_destroy(&port_handle);
  54    end_clock();
  55    setvect(0x23, old_vect23);                    /* restore ^C, ^Break     */
  56    setvect(0x1b, old_vect1b);
  57 }
  58
  59 int init_comm(char *cport,long baud,int two_stop)
  60 {
  61     printf("Port: %s, Baud rate: %i\n", port, baud);
  62    int port;
  63    int base,irq;
  64
  65    if (sscanf(cport,"%x,%x",&base,&irq) == 2) {
  66       port = COM1;
  67       com_config(COM1,base,irq);
  68    } else {
  69       if (strlen(cport) != 4 || strnicmp(cport,"COM",3) != 0 ||
  70             (cport[3] > '4' || cport[3] < '1')) {
  71          printf("Illegal port %s, must be com1 to com4\n",cport);
  72          exit(1);
  73       }
  74       switch(cport[3])
  75       {
  76         case '1': port = COM1; break;
  77         case '2': port = COM2; break;
  78         case '3': port = COM3; break;
  79         case '4': port = COM4; break;
  80         default:
  81            printf("Illegal port %s, must be com1 to com4\n",cport);
  82            exit(1);
  83       }
  84    }
  85    if( com_port_create(port, baud,'N',8,1 + two_stop, 4096, 4096,
  86       &port_handle) < 0 )
  87    {
  88      printf("Cannot create COM port");
  89      exit(1);
  90    }
  91
  92    init_clock(0x3333);
  93
  94    /*--------- take over 0x23 and 0x1B to suppress CTRL-C and Break ---------*/
  95    old_vect23 = getvect(0x23);
  96    old_vect1b = getvect(0x1b);
  97    setvect(0x23, en_ctrl_c);
  98    setvect(0x1b, en_ctrl_brk);
  99    atexit(cleanup);
 100
 101    com_clear_que(RX | TX, &port_handle);
 102
 103    if (port_handle.uart_type == ID_16550) {
 104       fifo_enable(&port_handle);
 105       com_fifo_trigger(RX_TRIG_4,&port_handle);
 106    }
 107
 108    return 0;
 109 }
 110
 111
 112 int getchar_nonblock(void) {
 113    if (kbhit()) {
 114       return getch();
 115    } else{
 116       return 0;
 117    }
 118 }
 119
 120 #else
 121
 122 #define ser_read(a,b,c) read(a,b,c)
 123 #define ser_write(a,b,c) write(a,b,c)
 124
 125 #ifdef _STDC_
 126 int init_comm(char *, long, int);
 127 #endif
 128
 129 int init_comm(port,baud,two_stop)
 130    char *port;
 131    long baud;
 132    int two_stop;
 133
 134 {
 135     printf("Port: %s, Baud rate: %i\n", port, baud);
 136
 137    struct termios tios;              /* Serial port TERMIO structure */
 138    int port_fd;
 139
 140    port_fd = open(port,O_RDWR,0);
 141    if (port_fd < 0) {
 142       fprintf (stderr,"init_comm: Open failed on port '%s': ",port);
 143       perror("");
 144       exit(1);
 145    }
 146
 147       /* Set to 8 bit selected baud no parity with no special processing */
 148    if (tcgetattr(port_fd,&tios) < 0) {
 149       perror("init_comm: tcgetattr failed");
 150       exit(1);
 151    }
 152    tios.c_cflag = CS8 | CREAD | HUPCL | CLOCAL | baud;
 153    if (two_stop)
 154       tios.c_cflag |= CSTOPB;
 155    tios.c_iflag = 0;
 156    tios.c_lflag = 0;
 157    tios.c_oflag = 0;
 158    tios.c_cc[VMIN] = 0;
 159    tios.c_cc[VTIME] = 1;
 160
 161    if (cfsetispeed(&tios,baud) != 0)
 162       printf("init_comm: set ispeed failed\n");
 163    if (cfsetospeed(&tios,baud) != 0)
 164       printf("init_comm: set ospeed failed\n");
 165
 166    if (tcsetattr(port_fd,TCSANOW,&tios) < 0) {
 167       perror("init_comm: tcsetattr failed");
 168       exit(1);
 169    }
 170    tcflush(port_fd,TCIOFLUSH);
 171    return(port_fd);
 172 }
 173
 174 struct termios orig_tios;              /* Serial port TERMIO structure */
 175
 176 void restore_termio() {
 177    if (tcsetattr(STDIN_FILENO,TCSANOW,&orig_tios) < 0) {
 178       perror("restore_termio: tcsetattr failed");
 179       exit(1);
 180    }
 181    printf("Terminal settings restored\n");
 182
 183    exit(0);
 184 }
 185
 186 void set_input_nonblock() {
 187    struct termios tios;              /* Serial port TERMIO structure */
 188
 189    signal(SIGINT, restore_termio);
 190    if (tcgetattr(STDIN_FILENO,&orig_tios) < 0) {
 191       perror("set_input_nonblock: tcgetattr failed");
 192       exit(1);
 193    }
 194    if (tcgetattr(STDIN_FILENO,&tios) < 0) {
 195       perror("tcgetattr failed");
 196       exit(1);
 197    }
 198    tios.c_cc[VMIN] = 0;
 199    tios.c_cc[VTIME] = 0;
 200    tios.c_lflag &= ~(ICANON | ECHO);
 201    if (tcsetattr(STDIN_FILENO,TCSANOW,&tios) < 0) {
 202       perror("set_input_nonblock: tcsetattr failed");
 203       exit(1);
 204    }
 205 }
 206
 207 int getchar_nonblock(void) {
 208    static int init = 0;
 209    if (!init) {
 210       set_input_nonblock();
 211       init = 1;
 212    }
 213
 214    return getchar();
 215 }
 216 #endif