URL https://opencores.org/ocsvn/or1k/or1k/trunk

Subversion Repositories or1k

[/] [or1k/] [trunk/] [rtems-20020807/] [c/] [src/] [libchip/] [serial/] [mc68681.c] - Blame information for rev 1026

Go to most recent revision | Details | Compare with Previous | View Log


/*
 *  This file contains the termios TTY driver for the Motorola MC68681.
 *
 *  This part is available from a number of secondary sources.
 *  In particular, we know about the following:
 *
 *     + Exar 88c681 and 68c681
 *
 *  COPYRIGHT (c) 1989-1999.
 *  On-Line Applications Research Corporation (OAR).
 *
 *  The license and distribution terms for this file may be
 *  found in the file LICENSE in this distribution or at
 *  http://www.OARcorp.com/rtems/license.html.
 *
 *  mc68681.c,v 1.28 2001/03/14 19:42:49 joel Exp
 */
 
#include <rtems.h>
#include <rtems/libio.h>
#include <stdlib.h>
 
#include <libchip/serial.h>
#include <libchip/mc68681.h>
#include <libchip/sersupp.h>
#include "mc68681_p.h"
 
/*
 * Flow control is only supported when using interrupts
 */
 
console_fns mc68681_fns =
{
  libchip_serial_default_probe,   /* deviceProbe */
  mc68681_open,                   /* deviceFirstOpen */
  NULL,                           /* deviceLastClose */
  NULL,                           /* deviceRead */
  mc68681_write_support_int,      /* deviceWrite */
  mc68681_initialize_interrupts,  /* deviceInitialize */
  mc68681_write_polled,           /* deviceWritePolled */
  mc68681_set_attributes,         /* deviceSetAttributes */
  TRUE                            /* deviceOutputUsesInterrupts */
};
 
console_fns mc68681_fns_polled =
{
  libchip_serial_default_probe,        /* deviceProbe */
  mc68681_open,                        /* deviceFirstOpen */
  mc68681_close,                       /* deviceLastClose */
  mc68681_inbyte_nonblocking_polled,   /* deviceRead */
  mc68681_write_support_polled,        /* deviceWrite */
  mc68681_init,                        /* deviceInitialize */
  mc68681_write_polled,                /* deviceWritePolled */
  mc68681_set_attributes,              /* deviceSetAttributes */
  FALSE,                               /* deviceOutputUsesInterrupts */
};
 
extern void set_vector( rtems_isr_entry, rtems_vector_number, int );
 
/*
 *  Console Device Driver Entry Points
 */
 
/*
 *  mc68681_baud_rate
 *
 *  This routine returns the proper ACR bit and baud rate field values
 *  based on the requested baud rate.  The baud rate set to be used
 *  must be configured by the user.
 */
 
MC68681_STATIC int mc68681_baud_rate(
  int           minor,
  int           baud,
  unsigned int *baud_mask_p,
  unsigned int *acr_bit_p,
  unsigned int *command
);
 
/*
 *  mc68681_set_attributes
 *
 *  This function sets the DUART channel to reflect the requested termios
 *  port settings.
 */
 
MC68681_STATIC int mc68681_set_attributes(
  int minor,
  const struct termios *t
)
{
  unsigned32             pMC68681_port;
  unsigned32             pMC68681;
  unsigned int           mode1;
  unsigned int           mode2;
  unsigned int           baud_mask;
  unsigned int           acr_bit;
  unsigned int           cmd;
  setRegister_f          setReg;
  rtems_interrupt_level  Irql;
 
  pMC68681      = Console_Port_Tbl[minor].ulCtrlPort1;
  pMC68681_port = Console_Port_Tbl[minor].ulCtrlPort2;
  setReg        = Console_Port_Tbl[minor].setRegister;
 
  /*
   *  Set the baud rate
   */
 
  if (mc68681_baud_rate( minor, t->c_cflag, &baud_mask, &acr_bit, &cmd ) == -1)
    return -1;
 
  baud_mask |=  baud_mask << 4;
  acr_bit   <<= 7;
 
  /*
   *  Parity
   */
 
  mode1 = 0;
  mode2 = 0;
 
  if (t->c_cflag & PARENB) {
    if (t->c_cflag & PARODD)
      mode1 |= 0x04;
    else
      mode1 |= 0x04;
  } else {
   mode1 |= 0x10;
  }
 
  /*
   *  Character Size
   */
 
  if (t->c_cflag & CSIZE) {
    switch (t->c_cflag & CSIZE) {
      case CS5:  break;
      case CS6:  mode1 |= 0x01;  break;
      case CS7:  mode1 |= 0x02;  break;
      case CS8:  mode1 |= 0x03;  break;
    }
  } else {
    mode1 |= 0x03;       /* default to 9600,8,N,1 */
  }
 
  /*
   *  Stop Bits
   */
 
  if (t->c_cflag & CSTOPB) {
    mode2 |= 0x07;                      /* 2 stop bits */
  } else {
    if ((t->c_cflag & CSIZE) == CS5)    /* CS5 and 2 stop bits not supported */
      return -1;
    mode2 |= 0x0F;                      /* 1 stop bit */
  }
 
  rtems_interrupt_disable(Irql);
    (*setReg)( pMC68681, MC68681_AUX_CTRL_REG, acr_bit );
    (*setReg)( pMC68681_port, MC68681_CLOCK_SELECT, baud_mask );
    if ( cmd ) {
      (*setReg)( pMC68681_port, MC68681_COMMAND, cmd );         /* RX */
      (*setReg)( pMC68681_port, MC68681_COMMAND, cmd | 0x20 );  /* TX */
    }
    (*setReg)( pMC68681_port, MC68681_COMMAND, MC68681_MODE_REG_RESET_MR_PTR );
    (*setReg)( pMC68681_port, MC68681_MODE, mode1 );
    (*setReg)( pMC68681_port, MC68681_MODE, mode2 );
  rtems_interrupt_enable(Irql);
  return 0;
}
 
/*
 *  mc68681_initialize_context
 *
 *  This function sets the default values of the per port context structure.
 */
 
MC68681_STATIC void mc68681_initialize_context(
  int               minor,
  mc68681_context  *pmc68681Context
)
{
  int          port;
  unsigned int pMC68681;
  unsigned int pMC68681_port;
 
  pMC68681      = Console_Port_Tbl[minor].ulCtrlPort1;
  pMC68681_port = Console_Port_Tbl[minor].ulCtrlPort2;
 
  pmc68681Context->mate = -1;
 
  for (port=0 ; port<Console_Port_Count ; port++ ) {
    if ( Console_Port_Tbl[port].ulCtrlPort1 == pMC68681 &&
         Console_Port_Tbl[port].ulCtrlPort2 != pMC68681_port ) {
      pmc68681Context->mate = port;
      pmc68681Context->imr  = 0;
      break;
    }
  }
 
}
 
/*
 *  mc68681_init
 *
 *  This function initializes the DUART to a quiecsent state.
 */
 
MC68681_STATIC void mc68681_init(int minor)
{
  unsigned32              pMC68681_port;
  unsigned32              pMC68681;
  mc68681_context        *pmc68681Context;
  setRegister_f           setReg;
  getRegister_f           getReg;
 
  pmc68681Context = (mc68681_context *) malloc(sizeof(mc68681_context));
 
  Console_Port_Data[minor].pDeviceContext = (void *)pmc68681Context;
 
  mc68681_initialize_context( minor, pmc68681Context );
 
  pMC68681      = Console_Port_Tbl[minor].ulCtrlPort1;
  pMC68681_port = Console_Port_Tbl[minor].ulCtrlPort2;
  setReg        = Console_Port_Tbl[minor].setRegister;
  getReg        = Console_Port_Tbl[minor].getRegister;
 
  /*
   *  Reset everything and leave this port disabled.
   */
 
  (*setReg)( pMC68681_port, MC68681_COMMAND, MC68681_MODE_REG_RESET_RX );
  (*setReg)( pMC68681_port, MC68681_COMMAND, MC68681_MODE_REG_RESET_TX );
  (*setReg)( pMC68681_port, MC68681_COMMAND, MC68681_MODE_REG_RESET_ERROR );
  (*setReg)( pMC68681_port, MC68681_COMMAND, MC68681_MODE_REG_RESET_BREAK );
  (*setReg)( pMC68681_port, MC68681_COMMAND, MC68681_MODE_REG_STOP_BREAK );
  (*setReg)( pMC68681_port, MC68681_COMMAND, MC68681_MODE_REG_DISABLE_TX );
  (*setReg)( pMC68681_port, MC68681_COMMAND, MC68681_MODE_REG_DISABLE_RX );
 
 
  (*setReg)( pMC68681_port, MC68681_MODE_REG_1A, 0x00 );
  (*setReg)( pMC68681_port, MC68681_MODE_REG_2A, 0x02 );
 
  /*
   *  Disable interrupts on RX and TX for this port
   */
 
  mc68681_enable_interrupts( minor, MC68681_IMR_DISABLE_ALL );
}
 
/*
 *  mc68681_open
 *
 *  This function opens a port for communication.
 *
 *  Default state is 9600 baud, 8 bits, No parity, and 1 stop bit.
 */
 
MC68681_STATIC int mc68681_open(
  int      major,
  int      minor,
  void    *arg
)
{
  unsigned32             pMC68681;
  unsigned32             pMC68681_port;
  unsigned int           baud;
  unsigned int           acr;
  unsigned int           vector;
  unsigned int           command;
  rtems_interrupt_level  Irql;
  setRegister_f          setReg;
 
  pMC68681      = Console_Port_Tbl[minor].ulCtrlPort1;
  pMC68681_port = Console_Port_Tbl[minor].ulCtrlPort2;
  setReg        = Console_Port_Tbl[minor].setRegister;
  vector        = Console_Port_Tbl[minor].ulIntVector;
 
  /* XXX default baud rate should be from configuration table */
 
  (void) mc68681_baud_rate( minor, B9600, &baud, &acr, &command );
 
  /*
   *  Set the DUART channel to a default useable state
   */
 
  rtems_interrupt_disable(Irql);
    (*setReg)( pMC68681, MC68681_AUX_CTRL_REG, acr );
    (*setReg)( pMC68681_port, MC68681_CLOCK_SELECT, baud );
    if ( command ) {
      (*setReg)( pMC68681_port, MC68681_COMMAND, command );         /* RX */
      (*setReg)( pMC68681_port, MC68681_COMMAND, command | 0x20 );  /* TX */
    }
    (*setReg)( pMC68681_port, MC68681_COMMAND, MC68681_MODE_REG_RESET_MR_PTR );
    (*setReg)( pMC68681_port, MC68681_MODE, 0x13 );
    (*setReg)( pMC68681_port, MC68681_MODE, 0x07 );
  rtems_interrupt_enable(Irql);
 
  (*setReg)( pMC68681_port, MC68681_COMMAND, MC68681_MODE_REG_ENABLE_TX );
  (*setReg)( pMC68681_port, MC68681_COMMAND, MC68681_MODE_REG_ENABLE_RX );
 
  (*setReg)( pMC68681, MC68681_INTERRUPT_VECTOR_REG, vector );
 
  return RTEMS_SUCCESSFUL;
}
 
/*
 *  mc68681_close
 *
 *  This function shuts down the requested port.
 */
 
MC68681_STATIC int mc68681_close(
  int      major,
  int      minor,
  void    *arg
)
{
  unsigned32      pMC68681;
  unsigned32      pMC68681_port;
  setRegister_f   setReg;
 
  pMC68681      = Console_Port_Tbl[minor].ulCtrlPort1;
  pMC68681_port = Console_Port_Tbl[minor].ulCtrlPort2;
  setReg        = Console_Port_Tbl[minor].setRegister;
 
  /*
   *  Disable interrupts from this channel and then disable it totally.
   */
 
#if 0
  (*setReg)( pMC68681_port, MC68681_COMMAND, MC68681_MODE_REG_DISABLE_TX );
  (*setReg)( pMC68681_port, MC68681_COMMAND, MC68681_MODE_REG_DISABLE_RX );
#endif
 
  return(RTEMS_SUCCESSFUL);
}
 
/*
 *  mc68681_write_polled
 *
 *  This routine polls out the requested character.
 */
 
MC68681_STATIC void mc68681_write_polled(
  int   minor,
  char  cChar
)
{
  unsigned32              pMC68681_port;
  unsigned char           ucLineStatus;
  int                     iTimeout;
  getRegister_f           getReg;
  setRegister_f           setReg;
 
  pMC68681_port = Console_Port_Tbl[minor].ulCtrlPort2;
  getReg        = Console_Port_Tbl[minor].getRegister;
  setReg        = Console_Port_Tbl[minor].setRegister;
 
  /*
   * wait for transmitter holding register to be empty
   */
  iTimeout = 1000;
  ucLineStatus = (*getReg)(pMC68681_port, MC68681_STATUS);
  while ((ucLineStatus & (MC68681_TX_READY|MC68681_TX_EMPTY)) == 0) {
 
    if ((ucLineStatus & 0xF0))
      (*setReg)( pMC68681_port, MC68681_COMMAND, MC68681_MODE_REG_RESET_ERROR );
 
    /*
     * Yield while we wait
     */
 
#if 0
     if(_System_state_Is_up(_System_state_Get())) {
       rtems_task_wake_after(RTEMS_YIELD_PROCESSOR);
     }
#endif
     ucLineStatus = (*getReg)(pMC68681_port, MC68681_STATUS);
     if(!--iTimeout) {
       break;
     }
  }
 
  /*
   * transmit character
   */
 
  (*setReg)(pMC68681_port, MC68681_TX_BUFFER, cChar);
}
 
/*
 *  mc68681_isr
 *
 *  This is the single interrupt entry point which parcels interrupts
 *  out to the various ports.
 */
 
MC68681_STATIC rtems_isr mc68681_isr(
  rtems_vector_number vector
)
{
  int     minor;
 
  for(minor=0 ; minor<Console_Port_Count ; minor++) {
    if(Console_Port_Tbl[minor].ulIntVector == vector &&
       Console_Port_Tbl[minor].deviceType == SERIAL_MC68681 ) {
      mc68681_process(minor);
    }
  }
}
 
/*
 *  mc68681_initialize_interrupts
 *
 *  This routine initializes the console's receive and transmit
 *  ring buffers and loads the appropriate vectors to handle the interrupts.
 */
 
MC68681_STATIC void mc68681_initialize_interrupts(int minor)
{
  mc68681_init(minor);
 
  Console_Port_Data[minor].bActive = FALSE;
 
  set_vector(mc68681_isr, Console_Port_Tbl[minor].ulIntVector, 1);
 
  mc68681_enable_interrupts(minor,MC68681_IMR_ENABLE_ALL_EXCEPT_TX);
}
 
/*
 *  mc68681_write_support_int
 *
 *  Console Termios output entry point when using interrupt driven output.
 */
 
MC68681_STATIC int mc68681_write_support_int(
  int         minor,
  const char *buf,
  int         len
)
{
  unsigned32      Irql;
  unsigned32      pMC68681_port;
  setRegister_f   setReg;
 
  pMC68681_port = Console_Port_Tbl[minor].ulCtrlPort2;
  setReg        = Console_Port_Tbl[minor].setRegister;
 
  /*
   *  We are using interrupt driven output and termios only sends us
   *  one character at a time.
   */
 
  if ( !len )
    return 0;
 
  /*
   *  Put the character out and enable interrupts if necessary.
   */
 
  rtems_interrupt_disable(Irql);
    if ( Console_Port_Data[minor].bActive == FALSE ) {
      Console_Port_Data[minor].bActive = TRUE;
      mc68681_enable_interrupts(minor, MC68681_IMR_ENABLE_ALL);
    }
    (*setReg)(pMC68681_port, MC68681_TX_BUFFER, *buf);
  rtems_interrupt_enable(Irql);
 
  return 1;
}
 
/*
 *  mc68681_write_support_polled
 *
 *  Console Termios output entry point when using polled output.
 *
 */
 
MC68681_STATIC int mc68681_write_support_polled(
  int         minor,
  const char *buf,
  int         len
)
{
  int nwrite = 0;
 
  /*
   * poll each byte in the string out of the port.
   */
  while (nwrite < len) {
    /*
     * transmit character
     */
    mc68681_write_polled(minor, *buf++);
    nwrite++;
  }
 
  /*
   * return the number of bytes written.
   */
  return nwrite;
}
 
/*
 *  mc68681_inbyte_nonblocking_polled
 *
 *  Console Termios polling input entry point.
 */
 
MC68681_STATIC int mc68681_inbyte_nonblocking_polled(
  int minor
)
{
  unsigned32           pMC68681_port;
  unsigned char        ucLineStatus;
  unsigned char        cChar;
  getRegister_f        getReg;
 
  pMC68681_port = Console_Port_Tbl[minor].ulCtrlPort2;
  getReg        = Console_Port_Tbl[minor].getRegister;
 
  ucLineStatus = (*getReg)(pMC68681_port, MC68681_STATUS);
  if(ucLineStatus & MC68681_RX_READY) {
    cChar = (*getReg)(pMC68681_port, MC68681_RX_BUFFER);
    return (int)cChar;
  } else {
    return -1;
  }
}
 
/*
 *  mc68681_baud_rate
 */
 
MC68681_STATIC int mc68681_baud_rate(
  int           minor,
  int           baud,
  unsigned int *baud_mask_p,
  unsigned int *acr_bit_p,
  unsigned int *command
)
{
  unsigned int           baud_mask;
  unsigned int           acr_bit;
  int                    status;
  int                    is_extended;
  int                    baud_requested;
  mc68681_baud_table_t  *baud_tbl;
 
  baud_mask = 0;
  acr_bit = 0;
  status = 0;
 
  if ( !(Console_Port_Tbl[minor].ulDataPort & MC68681_DATA_BAUD_RATE_SET_1) )
    acr_bit = 1;
 
  is_extended = 0;
 
  switch (Console_Port_Tbl[minor].ulDataPort & MC68681_XBRG_MASK) {
    case MC68681_XBRG_IGNORED:
      *command = 0x00;
      break;
    case MC68681_XBRG_ENABLED:
      *command = 0x80;
      is_extended = 1;
      break;
    case MC68681_XBRG_DISABLED:
      *command = 0x90;
      break;
  }
 
  baud_requested = baud & CBAUD;
  if (!baud_requested)
    baud_requested = B9600;              /* default to 9600 baud */
 
  baud_requested = termios_baud_to_index( baud_requested );
 
  baud_tbl = (mc68681_baud_table_t *) Console_Port_Tbl[minor].ulClock;
  if (!baud_tbl)
    rtems_fatal_error_occurred(RTEMS_INVALID_ADDRESS);
 
  if ( is_extended )
    baud_mask = (unsigned int)baud_tbl[ acr_bit + 2 ][ baud_requested ];
  else
    baud_mask = baud_tbl[ acr_bit ][ baud_requested ];
 
  if ( baud_mask == MC68681_BAUD_NOT_VALID )
    status = -1;
 
  /*
   *  upper nibble is receiver and lower nibble is transmitter
   */
 
  *baud_mask_p = (baud_mask << 4) | baud_mask;
  *acr_bit_p   = acr_bit;
  return status;
}
 
/*
 *  mc68681_process
 *
 *  This routine is the per port console interrupt handler.
 */
 
MC68681_STATIC void mc68681_process(
  int  minor
)
{
  unsigned32              pMC68681;
  unsigned32              pMC68681_port;
  volatile unsigned8      ucLineStatus;
  unsigned char           cChar;
  getRegister_f           getReg;
  setRegister_f           setReg;
 
  pMC68681      = Console_Port_Tbl[minor].ulCtrlPort1;
  pMC68681_port = Console_Port_Tbl[minor].ulCtrlPort2;
  getReg        = Console_Port_Tbl[minor].getRegister;
  setReg        = Console_Port_Tbl[minor].setRegister;
 
  /*
   * Deal with any received characters
   */
  while(TRUE) {
    ucLineStatus = (*getReg)(pMC68681_port, MC68681_STATUS);
    if(!(ucLineStatus & MC68681_RX_READY)) {
      break;
    }
    /*
     *  If there is a RX error, then dump all the data.
     */
    if ( ucLineStatus & MC68681_RX_ERRORS ) {
      do {
        cChar = (*getReg)(pMC68681_port, MC68681_RX_BUFFER);
        ucLineStatus = (*getReg)(pMC68681_port, MC68681_STATUS);
      } while ( ucLineStatus & MC68681_RX_READY );
      continue;
    }
    cChar = (*getReg)(pMC68681_port, MC68681_RX_BUFFER);
    rtems_termios_enqueue_raw_characters(
      Console_Port_Data[minor].termios_data,
      &cChar,
      1
    );
  }
 
  /*
   *  Deal with the transmitter
   */
 
  ucLineStatus = (*getReg)(pMC68681, MC68681_INTERRUPT_STATUS_REG);
  if (pMC68681 != pMC68681_port)
    ucLineStatus >>= 4;
 
  if(ucLineStatus & MC68681_IR_TX_READY) {
    if (rtems_termios_dequeue_characters(
         Console_Port_Data[minor].termios_data, 1)) {
      Console_Port_Data[minor].bActive = FALSE;
      mc68681_enable_interrupts(minor, MC68681_IMR_ENABLE_ALL_EXCEPT_TX);
    }
  }
 
}
 
/*
 *  mc68681_build_imr
 *
 *  This function returns the value for the interrupt mask register for this
 *  DUART.  Since this is a shared register, we must look at the other port
 *  on this chip to determine whether or not it is using interrupts.
 */
 
MC68681_STATIC unsigned int mc68681_build_imr(
  int  minor,
  int  enable_flag
)
{
  int              mate;
  int              is_a;
  unsigned int     mask;
  unsigned int     mate_mask;
  unsigned int     pMC68681;
  unsigned int     pMC68681_port;
  mc68681_context *pmc68681Context;
  mc68681_context *mateContext;
 
  pMC68681        = Console_Port_Tbl[minor].ulCtrlPort1;
  pMC68681_port   = Console_Port_Tbl[minor].ulCtrlPort2;
  pmc68681Context = (mc68681_context *) Console_Port_Data[minor].pDeviceContext;
  mate            = pmc68681Context->mate;
 
  mask = 0;
  mate_mask = 0;
 
  is_a = (pMC68681 == pMC68681_port);
 
  /*
   *  If there is a mate for this port, get its IMR mask.
   */
 
  if ( mate != -1 ) {
    mateContext = Console_Port_Data[mate].pDeviceContext;
 
    if (mateContext)
      mate_mask = mateContext->imr;
  }
 
  /*
   *  Calculate this port's IMR mask and save it in the context area.
   */
 
  if ( Console_Port_Tbl[minor].pDeviceFns->deviceOutputUsesInterrupts )
    mask = enable_flag;
 
  pmc68681Context->imr = mask;
 
  /*
   *  Now return the full IMR value
   */
 
  if (is_a)
    return (mate_mask << 4) | mask;
 
  return (mask << 4) | mate_mask;
}
 
/*
 *  mc68681_enable_interrupts
 *
 *  This function enables specific interrupt sources on the DUART.
 */
 
MC68681_STATIC void mc68681_enable_interrupts(
  int minor,
  int imr_mask
)
{
  unsigned32            pMC68681;
  setRegister_f         setReg;
 
  pMC68681 = Console_Port_Tbl[minor].ulCtrlPort1;
  setReg   = Console_Port_Tbl[minor].setRegister;
 
  /*
   *  Enable interrupts on RX and TX -- not break
   */
 
  (*setReg)(
     pMC68681,
     MC68681_INTERRUPT_MASK_REG,
     mc68681_build_imr(minor, imr_mask)
  );
}

Browse

Tools

Subversion Repositories or1k

[/] [or1k/] [trunk/] [rtems-20020807/] [c/] [src/] [libchip/] [serial/] [mc68681.c] - Blame information for rev 1026

Line No.	Rev	Author	Line
1	1026	ivang	`/*`
2			`* This file contains the termios TTY driver for the Motorola MC68681.`
3			`*`
4			`* This part is available from a number of secondary sources.`
5			`* In particular, we know about the following:`
6			`*`
7			`* + Exar 88c681 and 68c681`
8			`*`
9			`* COPYRIGHT (c) 1989-1999.`
10			`* On-Line Applications Research Corporation (OAR).`
11			`*`
12			`* The license and distribution terms for this file may be`
13			`* found in the file LICENSE in this distribution or at`
14			`* http://www.OARcorp.com/rtems/license.html.`
15			`*`
16			`* mc68681.c,v 1.28 2001/03/14 19:42:49 joel Exp`
17			`*/`
18
19			`#include <rtems.h>`
20			`#include <rtems/libio.h>`
21			`#include <stdlib.h>`
22
23			`#include <libchip/serial.h>`
24			`#include <libchip/mc68681.h>`
25			`#include <libchip/sersupp.h>`
26			`#include "mc68681_p.h"`
27
28			`/*`
29			`* Flow control is only supported when using interrupts`
30			`*/`
31
32			`console_fns mc68681_fns =`
33			`{`
34			`libchip_serial_default_probe, /* deviceProbe */`
35			`mc68681_open, /* deviceFirstOpen */`
36			`NULL, /* deviceLastClose */`
37			`NULL, /* deviceRead */`
38			`mc68681_write_support_int, /* deviceWrite */`
39			`mc68681_initialize_interrupts, /* deviceInitialize */`
40			`mc68681_write_polled, /* deviceWritePolled */`
41			`mc68681_set_attributes, /* deviceSetAttributes */`
42			`TRUE /* deviceOutputUsesInterrupts */`
43			`};`
44
45			`console_fns mc68681_fns_polled =`
46			`{`
47			`libchip_serial_default_probe, /* deviceProbe */`
48			`mc68681_open, /* deviceFirstOpen */`
49			`mc68681_close, /* deviceLastClose */`
50			`mc68681_inbyte_nonblocking_polled, /* deviceRead */`
51			`mc68681_write_support_polled, /* deviceWrite */`
52			`mc68681_init, /* deviceInitialize */`
53			`mc68681_write_polled, /* deviceWritePolled */`
54			`mc68681_set_attributes, /* deviceSetAttributes */`
55			`FALSE, /* deviceOutputUsesInterrupts */`
56			`};`
57
58			`extern void set_vector( rtems_isr_entry, rtems_vector_number, int );`
59
60			`/*`
61			`* Console Device Driver Entry Points`
62			`*/`
63
64			`/*`
65			`* mc68681_baud_rate`
66			`*`
67			`* This routine returns the proper ACR bit and baud rate field values`
68			`* based on the requested baud rate. The baud rate set to be used`
69			`* must be configured by the user.`
70			`*/`
71
72			`MC68681_STATIC int mc68681_baud_rate(`
73			`int minor,`
74			`int baud,`
75			`unsigned int *baud_mask_p,`
76			`unsigned int *acr_bit_p,`
77			`unsigned int *command`
78			`);`
79
80			`/*`
81			`* mc68681_set_attributes`
82			`*`
83			`* This function sets the DUART channel to reflect the requested termios`
84			`* port settings.`
85			`*/`
86
87			`MC68681_STATIC int mc68681_set_attributes(`
88			`int minor,`
89			`const struct termios *t`
90			`)`
91			`{`
92			`unsigned32 pMC68681_port;`
93			`unsigned32 pMC68681;`
94			`unsigned int mode1;`
95			`unsigned int mode2;`
96			`unsigned int baud_mask;`
97			`unsigned int acr_bit;`
98			`unsigned int cmd;`
99			`setRegister_f setReg;`
100			`rtems_interrupt_level Irql;`
101
102			`pMC68681 = Console_Port_Tbl[minor].ulCtrlPort1;`
103			`pMC68681_port = Console_Port_Tbl[minor].ulCtrlPort2;`
104			`setReg = Console_Port_Tbl[minor].setRegister;`
105
106			`/*`
107			`* Set the baud rate`
108			`*/`
109
110			`if (mc68681_baud_rate( minor, t->c_cflag, &baud_mask, &acr_bit, &cmd ) == -1)`
111			`return -1;`
112
113			`baud_mask \|= baud_mask << 4;`
114			`acr_bit <<= 7;`
115
116			`/*`
117			`* Parity`
118			`*/`
119
120			`mode1 = 0;`
121			`mode2 = 0;`
122
123			`if (t->c_cflag & PARENB) {`
124			`if (t->c_cflag & PARODD)`
125			`mode1 \|= 0x04;`
126			`else`
127			`mode1 \|= 0x04;`
128			`} else {`
129			`mode1 \|= 0x10;`
130			`}`
131
132			`/*`
133			`* Character Size`
134			`*/`
135
136			`if (t->c_cflag & CSIZE) {`
137			`switch (t->c_cflag & CSIZE) {`
138			`case CS5: break;`
139			`case CS6: mode1 \|= 0x01; break;`
140			`case CS7: mode1 \|= 0x02; break;`
141			`case CS8: mode1 \|= 0x03; break;`
142			`}`
143			`} else {`
144			`mode1 \|= 0x03; /* default to 9600,8,N,1 */`
145			`}`
146
147			`/*`
148			`* Stop Bits`
149			`*/`
150
151			`if (t->c_cflag & CSTOPB) {`
152			`mode2 \|= 0x07; /* 2 stop bits */`
153			`} else {`
154			`if ((t->c_cflag & CSIZE) == CS5) /* CS5 and 2 stop bits not supported */`
155			`return -1;`
156			`mode2 \|= 0x0F; /* 1 stop bit */`
157			`}`
158
159			`rtems_interrupt_disable(Irql);`
160			`(*setReg)( pMC68681, MC68681_AUX_CTRL_REG, acr_bit );`
161			`(*setReg)( pMC68681_port, MC68681_CLOCK_SELECT, baud_mask );`
162			`if ( cmd ) {`
163			`(setReg)( pMC68681_port, MC68681_COMMAND, cmd ); / RX */`
164			`(setReg)( pMC68681_port, MC68681_COMMAND, cmd \| 0x20 ); / TX */`
165			`}`
166			`(*setReg)( pMC68681_port, MC68681_COMMAND, MC68681_MODE_REG_RESET_MR_PTR );`
167			`(*setReg)( pMC68681_port, MC68681_MODE, mode1 );`
168			`(*setReg)( pMC68681_port, MC68681_MODE, mode2 );`
169			`rtems_interrupt_enable(Irql);`
170			`return 0;`
171			`}`
172
173			`/*`
174			`* mc68681_initialize_context`
175			`*`
176			`* This function sets the default values of the per port context structure.`
177			`*/`
178
179			`MC68681_STATIC void mc68681_initialize_context(`
180			`int minor,`
181			`mc68681_context *pmc68681Context`
182			`)`
183			`{`
184			`int port;`
185			`unsigned int pMC68681;`
186			`unsigned int pMC68681_port;`
187
188			`pMC68681 = Console_Port_Tbl[minor].ulCtrlPort1;`
189			`pMC68681_port = Console_Port_Tbl[minor].ulCtrlPort2;`
190
191			`pmc68681Context->mate = -1;`
192
193			`for (port=0 ; port<Console_Port_Count ; port++ ) {`
194			`if ( Console_Port_Tbl[port].ulCtrlPort1 == pMC68681 &&`
195			`Console_Port_Tbl[port].ulCtrlPort2 != pMC68681_port ) {`
196			`pmc68681Context->mate = port;`
197			`pmc68681Context->imr = 0;`
198			`break;`
199			`}`
200			`}`
201
202			`}`
203
204			`/*`
205			`* mc68681_init`
206			`*`
207			`* This function initializes the DUART to a quiecsent state.`
208			`*/`
209
210			`MC68681_STATIC void mc68681_init(int minor)`
211			`{`
212			`unsigned32 pMC68681_port;`
213			`unsigned32 pMC68681;`
214			`mc68681_context *pmc68681Context;`
215			`setRegister_f setReg;`
216			`getRegister_f getReg;`
217
218			`pmc68681Context = (mc68681_context *) malloc(sizeof(mc68681_context));`
219
220			`Console_Port_Data[minor].pDeviceContext = (void *)pmc68681Context;`
221
222			`mc68681_initialize_context( minor, pmc68681Context );`
223
224			`pMC68681 = Console_Port_Tbl[minor].ulCtrlPort1;`
225			`pMC68681_port = Console_Port_Tbl[minor].ulCtrlPort2;`
226			`setReg = Console_Port_Tbl[minor].setRegister;`
227			`getReg = Console_Port_Tbl[minor].getRegister;`
228
229			`/*`
230			`* Reset everything and leave this port disabled.`
231			`*/`
232
233			`(*setReg)( pMC68681_port, MC68681_COMMAND, MC68681_MODE_REG_RESET_RX );`
234			`(*setReg)( pMC68681_port, MC68681_COMMAND, MC68681_MODE_REG_RESET_TX );`
235			`(*setReg)( pMC68681_port, MC68681_COMMAND, MC68681_MODE_REG_RESET_ERROR );`
236			`(*setReg)( pMC68681_port, MC68681_COMMAND, MC68681_MODE_REG_RESET_BREAK );`
237			`(*setReg)( pMC68681_port, MC68681_COMMAND, MC68681_MODE_REG_STOP_BREAK );`
238			`(*setReg)( pMC68681_port, MC68681_COMMAND, MC68681_MODE_REG_DISABLE_TX );`
239			`(*setReg)( pMC68681_port, MC68681_COMMAND, MC68681_MODE_REG_DISABLE_RX );`
240
241
242			`(*setReg)( pMC68681_port, MC68681_MODE_REG_1A, 0x00 );`
243			`(*setReg)( pMC68681_port, MC68681_MODE_REG_2A, 0x02 );`
244
245			`/*`
246			`* Disable interrupts on RX and TX for this port`
247			`*/`
248
249			`mc68681_enable_interrupts( minor, MC68681_IMR_DISABLE_ALL );`
250			`}`
251
252			`/*`
253			`* mc68681_open`
254			`*`
255			`* This function opens a port for communication.`
256			`*`
257			`* Default state is 9600 baud, 8 bits, No parity, and 1 stop bit.`
258			`*/`
259
260			`MC68681_STATIC int mc68681_open(`
261			`int major,`
262			`int minor,`
263			`void *arg`
264			`)`
265			`{`
266			`unsigned32 pMC68681;`
267			`unsigned32 pMC68681_port;`
268			`unsigned int baud;`
269			`unsigned int acr;`
270			`unsigned int vector;`
271			`unsigned int command;`
272			`rtems_interrupt_level Irql;`
273			`setRegister_f setReg;`
274
275			`pMC68681 = Console_Port_Tbl[minor].ulCtrlPort1;`
276			`pMC68681_port = Console_Port_Tbl[minor].ulCtrlPort2;`
277			`setReg = Console_Port_Tbl[minor].setRegister;`
278			`vector = Console_Port_Tbl[minor].ulIntVector;`
279
280			`/* XXX default baud rate should be from configuration table */`
281
282			`(void) mc68681_baud_rate( minor, B9600, &baud, &acr, &command );`
283
284			`/*`
285			`* Set the DUART channel to a default useable state`
286			`*/`
287
288			`rtems_interrupt_disable(Irql);`
289			`(*setReg)( pMC68681, MC68681_AUX_CTRL_REG, acr );`
290			`(*setReg)( pMC68681_port, MC68681_CLOCK_SELECT, baud );`
291			`if ( command ) {`
292			`(setReg)( pMC68681_port, MC68681_COMMAND, command ); / RX */`
293			`(setReg)( pMC68681_port, MC68681_COMMAND, command \| 0x20 ); / TX */`
294			`}`
295			`(*setReg)( pMC68681_port, MC68681_COMMAND, MC68681_MODE_REG_RESET_MR_PTR );`
296			`(*setReg)( pMC68681_port, MC68681_MODE, 0x13 );`
297			`(*setReg)( pMC68681_port, MC68681_MODE, 0x07 );`
298			`rtems_interrupt_enable(Irql);`
299
300			`(*setReg)( pMC68681_port, MC68681_COMMAND, MC68681_MODE_REG_ENABLE_TX );`
301			`(*setReg)( pMC68681_port, MC68681_COMMAND, MC68681_MODE_REG_ENABLE_RX );`
302
303			`(*setReg)( pMC68681, MC68681_INTERRUPT_VECTOR_REG, vector );`
304
305			`return RTEMS_SUCCESSFUL;`
306			`}`
307
308			`/*`
309			`* mc68681_close`
310			`*`
311			`* This function shuts down the requested port.`
312			`*/`
313
314			`MC68681_STATIC int mc68681_close(`
315			`int major,`
316			`int minor,`
317			`void *arg`
318			`)`
319			`{`
320			`unsigned32 pMC68681;`
321			`unsigned32 pMC68681_port;`
322			`setRegister_f setReg;`
323
324			`pMC68681 = Console_Port_Tbl[minor].ulCtrlPort1;`
325			`pMC68681_port = Console_Port_Tbl[minor].ulCtrlPort2;`
326			`setReg = Console_Port_Tbl[minor].setRegister;`
327
328			`/*`
329			`* Disable interrupts from this channel and then disable it totally.`
330			`*/`
331
332			`#if 0`
333			`(*setReg)( pMC68681_port, MC68681_COMMAND, MC68681_MODE_REG_DISABLE_TX );`
334			`(*setReg)( pMC68681_port, MC68681_COMMAND, MC68681_MODE_REG_DISABLE_RX );`
335			`#endif`
336
337			`return(RTEMS_SUCCESSFUL);`
338			`}`
339
340			`/*`
341			`* mc68681_write_polled`
342			`*`
343			`* This routine polls out the requested character.`
344			`*/`
345
346			`MC68681_STATIC void mc68681_write_polled(`
347			`int minor,`
348			`char cChar`
349			`)`
350			`{`
351			`unsigned32 pMC68681_port;`
352			`unsigned char ucLineStatus;`
353			`int iTimeout;`
354			`getRegister_f getReg;`
355			`setRegister_f setReg;`
356
357			`pMC68681_port = Console_Port_Tbl[minor].ulCtrlPort2;`
358			`getReg = Console_Port_Tbl[minor].getRegister;`
359			`setReg = Console_Port_Tbl[minor].setRegister;`
360
361			`/*`
362			`* wait for transmitter holding register to be empty`
363			`*/`
364			`iTimeout = 1000;`
365			`ucLineStatus = (*getReg)(pMC68681_port, MC68681_STATUS);`
366			`while ((ucLineStatus & (MC68681_TX_READY\|MC68681_TX_EMPTY)) == 0) {`
367
368			`if ((ucLineStatus & 0xF0))`
369			`(*setReg)( pMC68681_port, MC68681_COMMAND, MC68681_MODE_REG_RESET_ERROR );`
370
371			`/*`
372			`* Yield while we wait`
373			`*/`
374
375			`#if 0`
376			`if(_System_state_Is_up(_System_state_Get())) {`
377			`rtems_task_wake_after(RTEMS_YIELD_PROCESSOR);`
378			`}`
379			`#endif`
380			`ucLineStatus = (*getReg)(pMC68681_port, MC68681_STATUS);`
381			`if(!--iTimeout) {`
382			`break;`
383			`}`
384			`}`
385
386			`/*`
387			`* transmit character`
388			`*/`
389
390			`(*setReg)(pMC68681_port, MC68681_TX_BUFFER, cChar);`
391			`}`
392
393			`/*`
394			`* mc68681_isr`
395			`*`
396			`* This is the single interrupt entry point which parcels interrupts`
397			`* out to the various ports.`
398			`*/`
399
400			`MC68681_STATIC rtems_isr mc68681_isr(`
401			`rtems_vector_number vector`
402			`)`
403			`{`
404			`int minor;`
405
406			`for(minor=0 ; minor<Console_Port_Count ; minor++) {`
407			`if(Console_Port_Tbl[minor].ulIntVector == vector &&`
408			`Console_Port_Tbl[minor].deviceType == SERIAL_MC68681 ) {`
409			`mc68681_process(minor);`
410			`}`
411			`}`
412			`}`
413
414			`/*`
415			`* mc68681_initialize_interrupts`
416			`*`
417			`* This routine initializes the console's receive and transmit`
418			`* ring buffers and loads the appropriate vectors to handle the interrupts.`
419			`*/`
420
421			`MC68681_STATIC void mc68681_initialize_interrupts(int minor)`
422			`{`
423			`mc68681_init(minor);`
424
425			`Console_Port_Data[minor].bActive = FALSE;`
426
427			`set_vector(mc68681_isr, Console_Port_Tbl[minor].ulIntVector, 1);`
428
429			`mc68681_enable_interrupts(minor,MC68681_IMR_ENABLE_ALL_EXCEPT_TX);`
430			`}`
431
432			`/*`
433			`* mc68681_write_support_int`
434			`*`
435			`* Console Termios output entry point when using interrupt driven output.`
436			`*/`
437
438			`MC68681_STATIC int mc68681_write_support_int(`
439			`int minor,`
440			`const char *buf,`
441			`int len`
442			`)`
443			`{`
444			`unsigned32 Irql;`
445			`unsigned32 pMC68681_port;`
446			`setRegister_f setReg;`
447
448			`pMC68681_port = Console_Port_Tbl[minor].ulCtrlPort2;`
449			`setReg = Console_Port_Tbl[minor].setRegister;`
450
451			`/*`
452			`* We are using interrupt driven output and termios only sends us`
453			`* one character at a time.`
454			`*/`
455
456			`if ( !len )`
457			`return 0;`
458
459			`/*`
460			`* Put the character out and enable interrupts if necessary.`
461			`*/`
462
463			`rtems_interrupt_disable(Irql);`
464			`if ( Console_Port_Data[minor].bActive == FALSE ) {`
465			`Console_Port_Data[minor].bActive = TRUE;`
466			`mc68681_enable_interrupts(minor, MC68681_IMR_ENABLE_ALL);`
467			`}`
468			`(setReg)(pMC68681_port, MC68681_TX_BUFFER, buf);`
469			`rtems_interrupt_enable(Irql);`
470
471			`return 1;`
472			`}`
473
474			`/*`
475			`* mc68681_write_support_polled`
476			`*`
477			`* Console Termios output entry point when using polled output.`
478			`*`
479			`*/`
480
481			`MC68681_STATIC int mc68681_write_support_polled(`
482			`int minor,`
483			`const char *buf,`
484			`int len`
485			`)`
486			`{`
487			`int nwrite = 0;`
488
489			`/*`
490			`* poll each byte in the string out of the port.`
491			`*/`
492			`while (nwrite < len) {`
493			`/*`
494			`* transmit character`
495			`*/`
496			`mc68681_write_polled(minor, *buf++);`
497			`nwrite++;`
498			`}`
499
500			`/*`
501			`* return the number of bytes written.`
502			`*/`
503			`return nwrite;`
504			`}`
505
506			`/*`
507			`* mc68681_inbyte_nonblocking_polled`
508			`*`
509			`* Console Termios polling input entry point.`
510			`*/`
511
512			`MC68681_STATIC int mc68681_inbyte_nonblocking_polled(`
513			`int minor`
514			`)`
515			`{`
516			`unsigned32 pMC68681_port;`
517			`unsigned char ucLineStatus;`
518			`unsigned char cChar;`
519			`getRegister_f getReg;`
520
521			`pMC68681_port = Console_Port_Tbl[minor].ulCtrlPort2;`
522			`getReg = Console_Port_Tbl[minor].getRegister;`
523
524			`ucLineStatus = (*getReg)(pMC68681_port, MC68681_STATUS);`
525			`if(ucLineStatus & MC68681_RX_READY) {`
526			`cChar = (*getReg)(pMC68681_port, MC68681_RX_BUFFER);`
527			`return (int)cChar;`
528			`} else {`
529			`return -1;`
530			`}`
531			`}`
532
533			`/*`
534			`* mc68681_baud_rate`
535			`*/`
536
537			`MC68681_STATIC int mc68681_baud_rate(`
538			`int minor,`
539			`int baud,`
540			`unsigned int *baud_mask_p,`
541			`unsigned int *acr_bit_p,`
542			`unsigned int *command`
543			`)`
544			`{`
545			`unsigned int baud_mask;`
546			`unsigned int acr_bit;`
547			`int status;`
548			`int is_extended;`
549			`int baud_requested;`
550			`mc68681_baud_table_t *baud_tbl;`
551
552			`baud_mask = 0;`
553			`acr_bit = 0;`
554			`status = 0;`
555
556			`if ( !(Console_Port_Tbl[minor].ulDataPort & MC68681_DATA_BAUD_RATE_SET_1) )`
557			`acr_bit = 1;`
558
559			`is_extended = 0;`
560
561			`switch (Console_Port_Tbl[minor].ulDataPort & MC68681_XBRG_MASK) {`
562			`case MC68681_XBRG_IGNORED:`
563			`*command = 0x00;`
564			`break;`
565			`case MC68681_XBRG_ENABLED:`
566			`*command = 0x80;`
567			`is_extended = 1;`
568			`break;`
569			`case MC68681_XBRG_DISABLED:`
570			`*command = 0x90;`
571			`break;`
572			`}`
573
574			`baud_requested = baud & CBAUD;`
575			`if (!baud_requested)`
576			`baud_requested = B9600; /* default to 9600 baud */`
577
578			`baud_requested = termios_baud_to_index( baud_requested );`
579
580			`baud_tbl = (mc68681_baud_table_t *) Console_Port_Tbl[minor].ulClock;`
581			`if (!baud_tbl)`
582			`rtems_fatal_error_occurred(RTEMS_INVALID_ADDRESS);`
583
584			`if ( is_extended )`
585			`baud_mask = (unsigned int)baud_tbl[ acr_bit + 2 ][ baud_requested ];`
586			`else`
587			`baud_mask = baud_tbl[ acr_bit ][ baud_requested ];`
588
589			`if ( baud_mask == MC68681_BAUD_NOT_VALID )`
590			`status = -1;`
591
592			`/*`
593			`* upper nibble is receiver and lower nibble is transmitter`
594			`*/`
595
596			`*baud_mask_p = (baud_mask << 4) \| baud_mask;`
597			`*acr_bit_p = acr_bit;`
598			`return status;`
599			`}`
600
601			`/*`
602			`* mc68681_process`
603			`*`
604			`* This routine is the per port console interrupt handler.`
605			`*/`
606
607			`MC68681_STATIC void mc68681_process(`
608			`int minor`
609			`)`
610			`{`
611			`unsigned32 pMC68681;`
612			`unsigned32 pMC68681_port;`
613			`volatile unsigned8 ucLineStatus;`
614			`unsigned char cChar;`
615			`getRegister_f getReg;`
616			`setRegister_f setReg;`
617
618			`pMC68681 = Console_Port_Tbl[minor].ulCtrlPort1;`
619			`pMC68681_port = Console_Port_Tbl[minor].ulCtrlPort2;`
620			`getReg = Console_Port_Tbl[minor].getRegister;`
621			`setReg = Console_Port_Tbl[minor].setRegister;`
622
623			`/*`
624			`* Deal with any received characters`
625			`*/`
626			`while(TRUE) {`
627			`ucLineStatus = (*getReg)(pMC68681_port, MC68681_STATUS);`
628			`if(!(ucLineStatus & MC68681_RX_READY)) {`
629			`break;`
630			`}`
631			`/*`
632			`* If there is a RX error, then dump all the data.`
633			`*/`
634			`if ( ucLineStatus & MC68681_RX_ERRORS ) {`
635			`do {`
636			`cChar = (*getReg)(pMC68681_port, MC68681_RX_BUFFER);`
637			`ucLineStatus = (*getReg)(pMC68681_port, MC68681_STATUS);`
638			`} while ( ucLineStatus & MC68681_RX_READY );`
639			`continue;`
640			`}`
641			`cChar = (*getReg)(pMC68681_port, MC68681_RX_BUFFER);`
642			`rtems_termios_enqueue_raw_characters(`
643			`Console_Port_Data[minor].termios_data,`
644			`&cChar,`
645			`1`
646			`);`
647			`}`
648
649			`/*`
650			`* Deal with the transmitter`
651			`*/`
652
653			`ucLineStatus = (*getReg)(pMC68681, MC68681_INTERRUPT_STATUS_REG);`
654			`if (pMC68681 != pMC68681_port)`
655			`ucLineStatus >>= 4;`
656
657			`if(ucLineStatus & MC68681_IR_TX_READY) {`
658			`if (rtems_termios_dequeue_characters(`
659			`Console_Port_Data[minor].termios_data, 1)) {`
660			`Console_Port_Data[minor].bActive = FALSE;`
661			`mc68681_enable_interrupts(minor, MC68681_IMR_ENABLE_ALL_EXCEPT_TX);`
662			`}`
663			`}`
664
665			`}`
666
667			`/*`
668			`* mc68681_build_imr`
669			`*`
670			`* This function returns the value for the interrupt mask register for this`
671			`* DUART. Since this is a shared register, we must look at the other port`
672			`* on this chip to determine whether or not it is using interrupts.`
673			`*/`
674
675			`MC68681_STATIC unsigned int mc68681_build_imr(`
676			`int minor,`
677			`int enable_flag`
678			`)`
679			`{`
680			`int mate;`
681			`int is_a;`
682			`unsigned int mask;`
683			`unsigned int mate_mask;`
684			`unsigned int pMC68681;`
685			`unsigned int pMC68681_port;`
686			`mc68681_context *pmc68681Context;`
687			`mc68681_context *mateContext;`
688
689			`pMC68681 = Console_Port_Tbl[minor].ulCtrlPort1;`
690			`pMC68681_port = Console_Port_Tbl[minor].ulCtrlPort2;`
691			`pmc68681Context = (mc68681_context *) Console_Port_Data[minor].pDeviceContext;`
692			`mate = pmc68681Context->mate;`
693
694			`mask = 0;`
695			`mate_mask = 0;`
696
697			`is_a = (pMC68681 == pMC68681_port);`
698
699			`/*`
700			`* If there is a mate for this port, get its IMR mask.`
701			`*/`
702
703			`if ( mate != -1 ) {`
704			`mateContext = Console_Port_Data[mate].pDeviceContext;`
705
706			`if (mateContext)`
707			`mate_mask = mateContext->imr;`
708			`}`
709
710			`/*`
711			`* Calculate this port's IMR mask and save it in the context area.`
712			`*/`
713
714			`if ( Console_Port_Tbl[minor].pDeviceFns->deviceOutputUsesInterrupts )`
715			`mask = enable_flag;`
716
717			`pmc68681Context->imr = mask;`
718
719			`/*`
720			`* Now return the full IMR value`
721			`*/`
722
723			`if (is_a)`
724			`return (mate_mask << 4) \| mask;`
725
726			`return (mask << 4) \| mate_mask;`
727			`}`
728
729			`/*`
730			`* mc68681_enable_interrupts`
731			`*`
732			`* This function enables specific interrupt sources on the DUART.`
733			`*/`
734
735			`MC68681_STATIC void mc68681_enable_interrupts(`
736			`int minor,`
737			`int imr_mask`
738			`)`
739			`{`
740			`unsigned32 pMC68681;`
741			`setRegister_f setReg;`
742
743			`pMC68681 = Console_Port_Tbl[minor].ulCtrlPort1;`
744			`setReg = Console_Port_Tbl[minor].setRegister;`
745
746			`/*`
747			`* Enable interrupts on RX and TX -- not break`
748			`*/`
749
750			`(*setReg)(`
751			`pMC68681,`
752			`MC68681_INTERRUPT_MASK_REG,`
753			`mc68681_build_imr(minor, imr_mask)`
754			`);`
755			`}`