Indented.
This commit is contained in:
skarg
+252
-233
@@ -35,329 +35,348 @@ QUEUE *Serial_In_Queue;
|
||||
QUEUE *Serial_Out_Queue;
|
||||
|
||||
OLD_COMM_PARAMS old_comm_params;
|
||||
COMM_STATUS comm_status;
|
||||
COMM_STATUS comm_status;
|
||||
|
||||
void (INTERRUPT FAR *oldvector_serial )();
|
||||
void (
|
||||
INTERRUPT FAR * oldvector_serial) (
|
||||
);
|
||||
/* save addr for intr handler */
|
||||
|
||||
int ComBase; /* Comm port address */
|
||||
int IrqNum; /* Comm interrupt request */
|
||||
int ComBase; /* Comm port address */
|
||||
int IrqNum; /* Comm interrupt request */
|
||||
|
||||
void CloseComPort ( void )
|
||||
void CloseComPort(
|
||||
void)
|
||||
{
|
||||
int status;
|
||||
int status;
|
||||
|
||||
/* restore UART to previous state */
|
||||
/* restore UART to previous state */
|
||||
|
||||
outp ( ComBase + INT_EN, (unsigned char) 0 );
|
||||
outp ( ComBase + MODEM_CNTRL,
|
||||
(unsigned char) old_comm_params.modem );
|
||||
status = inp ( ComBase + LINE_CNTRL );
|
||||
outp ( ComBase + LINE_CNTRL,
|
||||
(unsigned char) status | 0x80 );
|
||||
outp ( ComBase + BAUD_LSB,
|
||||
(unsigned char) old_comm_params.baud_lsb );
|
||||
outp ( ComBase + BAUD_MSB,
|
||||
(unsigned char) old_comm_params.baud_msb );
|
||||
outp ( ComBase + LINE_CNTRL,
|
||||
(unsigned char) old_comm_params.line );
|
||||
outp ( 0x21, (unsigned char) old_comm_params.int_cntrl );
|
||||
outp(ComBase + INT_EN, (unsigned char) 0);
|
||||
outp(ComBase + MODEM_CNTRL, (unsigned char) old_comm_params.modem);
|
||||
status = inp(ComBase + LINE_CNTRL);
|
||||
outp(ComBase + LINE_CNTRL, (unsigned char) status | 0x80);
|
||||
outp(ComBase + BAUD_LSB, (unsigned char) old_comm_params.baud_lsb);
|
||||
outp(ComBase + BAUD_MSB, (unsigned char) old_comm_params.baud_msb);
|
||||
outp(ComBase + LINE_CNTRL, (unsigned char) old_comm_params.line);
|
||||
outp(0x21, (unsigned char) old_comm_params.int_cntrl);
|
||||
|
||||
/* restore old interrupt handler */
|
||||
/* restore old interrupt handler */
|
||||
|
||||
setvect ( IrqNum + 8, oldvector_serial );
|
||||
setvect(IrqNum + 8, oldvector_serial);
|
||||
|
||||
/* free input and output queues */
|
||||
/* free input and output queues */
|
||||
|
||||
free ( Serial_In_Queue );
|
||||
free ( Serial_Out_Queue );
|
||||
return;
|
||||
free(Serial_In_Queue);
|
||||
free(Serial_Out_Queue);
|
||||
return;
|
||||
}
|
||||
|
||||
int OpenComPort ( char Port ) /* install int. handler */
|
||||
{
|
||||
unsigned status;
|
||||
int retval = -1;
|
||||
|
||||
/* allocate input and output queues */
|
||||
int OpenComPort(
|
||||
char Port)
|
||||
{ /* install int. handler */
|
||||
unsigned status;
|
||||
int retval = -1;
|
||||
|
||||
Serial_In_Queue = alloc_queue( SerInBufSize );
|
||||
if ( (QUEUE *) 0 == Serial_In_Queue)
|
||||
return retval;
|
||||
Serial_Out_Queue = alloc_queue( SerOutBufSize );
|
||||
if ( (QUEUE *) 0 == Serial_Out_Queue)
|
||||
{
|
||||
free ( Serial_In_Queue );
|
||||
return retval;
|
||||
}
|
||||
retval = 0;
|
||||
/* allocate input and output queues */
|
||||
|
||||
/* Setup Comm base port address and IRQ number */
|
||||
Serial_In_Queue = alloc_queue(SerInBufSize);
|
||||
if ((QUEUE *) 0 == Serial_In_Queue)
|
||||
return retval;
|
||||
Serial_Out_Queue = alloc_queue(SerOutBufSize);
|
||||
if ((QUEUE *) 0 == Serial_Out_Queue) {
|
||||
free(Serial_In_Queue);
|
||||
return retval;
|
||||
}
|
||||
retval = 0;
|
||||
|
||||
switch ( Port)
|
||||
{
|
||||
case '1': ComBase = 0x3F8; IrqNum = 4; break;
|
||||
case '2': ComBase = 0x2F8; IrqNum = 3; break;
|
||||
case '3': ComBase = 0x3E8; IrqNum = 4; break;
|
||||
case '4': ComBase = 0x2E8; IrqNum = 3; break;
|
||||
default : ComBase = 0x3F8; IrqNum = 4; break;
|
||||
}
|
||||
old_comm_params.int_enable = inp ( ComBase + INT_EN );
|
||||
outp ( ComBase + INT_EN, 0 ); /* turn off comm interrupts */
|
||||
/* Setup Comm base port address and IRQ number */
|
||||
|
||||
/* save old comm parameters */
|
||||
switch (Port) {
|
||||
case '1':
|
||||
ComBase = 0x3F8;
|
||||
IrqNum = 4;
|
||||
break;
|
||||
case '2':
|
||||
ComBase = 0x2F8;
|
||||
IrqNum = 3;
|
||||
break;
|
||||
case '3':
|
||||
ComBase = 0x3E8;
|
||||
IrqNum = 4;
|
||||
break;
|
||||
case '4':
|
||||
ComBase = 0x2E8;
|
||||
IrqNum = 3;
|
||||
break;
|
||||
default:
|
||||
ComBase = 0x3F8;
|
||||
IrqNum = 4;
|
||||
break;
|
||||
}
|
||||
old_comm_params.int_enable = inp(ComBase + INT_EN);
|
||||
outp(ComBase + INT_EN, 0); /* turn off comm interrupts */
|
||||
|
||||
old_comm_params.line = inp ( ComBase + LINE_CNTRL );
|
||||
old_comm_params.modem = inp ( ComBase + MODEM_CNTRL );
|
||||
status = inp ( ComBase + LINE_CNTRL );
|
||||
outp ( ComBase + LINE_CNTRL, (unsigned char) status | 0x80 );
|
||||
old_comm_params.baud_lsb = inp ( ComBase + BAUD_LSB );
|
||||
old_comm_params.baud_msb = inp ( ComBase + BAUD_MSB );
|
||||
status = inp ( ComBase + LINE_CNTRL );
|
||||
outp ( ComBase + LINE_CNTRL, (unsigned char) status | 0x7F );
|
||||
status = OUT2 | DTR; /* DTR/OUT2 must be set! */
|
||||
outp ( ComBase + MODEM_CNTRL, (unsigned char) status );
|
||||
/* save old comm parameters */
|
||||
|
||||
/* get serial port address/vector */
|
||||
old_comm_params.line = inp(ComBase + LINE_CNTRL);
|
||||
old_comm_params.modem = inp(ComBase + MODEM_CNTRL);
|
||||
status = inp(ComBase + LINE_CNTRL);
|
||||
outp(ComBase + LINE_CNTRL, (unsigned char) status | 0x80);
|
||||
old_comm_params.baud_lsb = inp(ComBase + BAUD_LSB);
|
||||
old_comm_params.baud_msb = inp(ComBase + BAUD_MSB);
|
||||
status = inp(ComBase + LINE_CNTRL);
|
||||
outp(ComBase + LINE_CNTRL, (unsigned char) status | 0x7F);
|
||||
status = OUT2 | DTR; /* DTR/OUT2 must be set! */
|
||||
outp(ComBase + MODEM_CNTRL, (unsigned char) status);
|
||||
|
||||
oldvector_serial = (void(INTERRUPT FAR *)(void))getvect(IrqNum + 8 );
|
||||
/* get serial port address/vector */
|
||||
|
||||
/* set our interrupt handler */
|
||||
oldvector_serial = (void (INTERRUPT FAR *) (void)) getvect(IrqNum + 8);
|
||||
|
||||
setvect ( IrqNum + 8, serial );
|
||||
/* set our interrupt handler */
|
||||
|
||||
/* save the PIC */
|
||||
setvect(IrqNum + 8, serial);
|
||||
|
||||
old_comm_params.int_cntrl = inp ( 0x21 );
|
||||
status = ( 1 << IrqNum); /* calculate int enable bit */
|
||||
status = ~status;
|
||||
/* save the PIC */
|
||||
|
||||
/* ok enable comm ints */
|
||||
old_comm_params.int_cntrl = inp(0x21);
|
||||
status = (1 << IrqNum); /* calculate int enable bit */
|
||||
status = ~status;
|
||||
|
||||
outp ( 0x21, (unsigned char) old_comm_params.int_cntrl &
|
||||
(unsigned char) status );
|
||||
|
||||
atexit(CloseComPort);
|
||||
|
||||
return retval;
|
||||
/* ok enable comm ints */
|
||||
|
||||
outp(0x21,
|
||||
(unsigned char) old_comm_params.int_cntrl & (unsigned char) status);
|
||||
|
||||
atexit(CloseComPort);
|
||||
|
||||
return retval;
|
||||
}
|
||||
|
||||
void InitComPort ( char Baud[], char Databits,
|
||||
char Parity, char Stopbits )
|
||||
void InitComPort(
|
||||
char Baud[],
|
||||
char Databits,
|
||||
char Parity,
|
||||
char Stopbits)
|
||||
{
|
||||
int status;
|
||||
unsigned divisor;
|
||||
long baudrate;
|
||||
int status;
|
||||
unsigned divisor;
|
||||
long baudrate;
|
||||
|
||||
/* set baud rate */
|
||||
/* set baud rate */
|
||||
|
||||
status = inp ( ComBase + LINE_CNTRL );
|
||||
outp ( ComBase + LINE_CNTRL,
|
||||
(unsigned char) status | 0x80 );
|
||||
baudrate = atol(Baud);
|
||||
if ( baudrate == 0)
|
||||
baudrate = 2400L;
|
||||
divisor = (unsigned) ( 115200L / baudrate);
|
||||
outp ( ComBase + BAUD_LSB,
|
||||
(unsigned char) ( divisor & 0x00FF) );
|
||||
outp ( ComBase + BAUD_MSB,
|
||||
(unsigned char) ( ( divisor >> 8) & 0x00FF) );
|
||||
status = 0x00;
|
||||
status = inp(ComBase + LINE_CNTRL);
|
||||
outp(ComBase + LINE_CNTRL, (unsigned char) status | 0x80);
|
||||
baudrate = atol(Baud);
|
||||
if (baudrate == 0)
|
||||
baudrate = 2400L;
|
||||
divisor = (unsigned) (115200L / baudrate);
|
||||
outp(ComBase + BAUD_LSB, (unsigned char) (divisor & 0x00FF));
|
||||
outp(ComBase + BAUD_MSB, (unsigned char) ((divisor >> 8) & 0x00FF));
|
||||
status = 0x00;
|
||||
|
||||
/* set parity */
|
||||
/* set parity */
|
||||
|
||||
switch ( Parity) /* set parity value */
|
||||
{
|
||||
case 'O': /* odd parity */
|
||||
case 'o':
|
||||
status = 0x08; break;
|
||||
switch (Parity) { /* set parity value */
|
||||
case 'O': /* odd parity */
|
||||
case 'o':
|
||||
status = 0x08;
|
||||
break;
|
||||
|
||||
case 'E': /* even parity */
|
||||
case 'e':
|
||||
status = 0x18; break;
|
||||
case 'E': /* even parity */
|
||||
case 'e':
|
||||
status = 0x18;
|
||||
break;
|
||||
|
||||
case 'S': /* stick parity */
|
||||
case 's':
|
||||
status = 0x28; break;
|
||||
case 'S': /* stick parity */
|
||||
case 's':
|
||||
status = 0x28;
|
||||
break;
|
||||
|
||||
case 'N': /* no parity */
|
||||
case 'n':
|
||||
default : status = 0x00;
|
||||
}
|
||||
case 'N': /* no parity */
|
||||
case 'n':
|
||||
default:
|
||||
status = 0x00;
|
||||
}
|
||||
|
||||
/* set number data bits */
|
||||
|
||||
switch ( Databits)
|
||||
{
|
||||
case '5':
|
||||
switch (Databits) {
|
||||
case '5':
|
||||
break;
|
||||
|
||||
case '6':
|
||||
case '6':
|
||||
status = status | 0x01;
|
||||
break;
|
||||
|
||||
case '7':
|
||||
case '7':
|
||||
status = status | 0x02;
|
||||
break;
|
||||
|
||||
case '8':
|
||||
default :
|
||||
case '8':
|
||||
default:
|
||||
status = status | 0x03;
|
||||
}
|
||||
}
|
||||
|
||||
/* set number stop bits */
|
||||
/* set number stop bits */
|
||||
|
||||
switch ( Stopbits)
|
||||
{
|
||||
case '2':
|
||||
switch (Stopbits) {
|
||||
case '2':
|
||||
status = status | 0x04;
|
||||
break;
|
||||
|
||||
case '1':
|
||||
default :
|
||||
case '1':
|
||||
default:
|
||||
;
|
||||
}
|
||||
outp ( ComBase + LINE_CNTRL, (unsigned char) status );
|
||||
status = OUT2 | DTR; /* DTR/OUT2 must be set! */
|
||||
outp ( ComBase + MODEM_CNTRL, (unsigned char) status );
|
||||
}
|
||||
outp(ComBase + LINE_CNTRL, (unsigned char) status);
|
||||
status = OUT2 | DTR; /* DTR/OUT2 must be set! */
|
||||
outp(ComBase + MODEM_CNTRL, (unsigned char) status);
|
||||
|
||||
/* enable serial interrupts */
|
||||
/* enable serial interrupts */
|
||||
|
||||
outp ( ComBase + INT_EN, RX_INT | ERR_INT | RS_INT );
|
||||
return;
|
||||
outp(ComBase + INT_EN, RX_INT | ERR_INT | RS_INT);
|
||||
return;
|
||||
}
|
||||
|
||||
void DropDtr ( void )
|
||||
void DropDtr(
|
||||
void)
|
||||
{
|
||||
int status;
|
||||
int status;
|
||||
|
||||
status = inp ( ComBase + MODEM_CNTRL );
|
||||
status &= 0xFE; /* turn off DTR bit */
|
||||
outp ( ComBase + MODEM_CNTRL, (unsigned char) status );
|
||||
return;
|
||||
status = inp(ComBase + MODEM_CNTRL);
|
||||
status &= 0xFE; /* turn off DTR bit */
|
||||
outp(ComBase + MODEM_CNTRL, (unsigned char) status);
|
||||
return;
|
||||
}
|
||||
|
||||
void RaiseDtr ( void )
|
||||
void RaiseDtr(
|
||||
void)
|
||||
{
|
||||
int status;
|
||||
int status;
|
||||
|
||||
status = inp ( ComBase + MODEM_CNTRL );
|
||||
status |= 0x01; /* turn on DTR bit */
|
||||
outp ( ComBase + MODEM_CNTRL, (unsigned char) status );
|
||||
return;
|
||||
status = inp(ComBase + MODEM_CNTRL);
|
||||
status |= 0x01; /* turn on DTR bit */
|
||||
outp(ComBase + MODEM_CNTRL, (unsigned char) status);
|
||||
return;
|
||||
}
|
||||
|
||||
int ComRecChar ( void )
|
||||
int ComRecChar(
|
||||
void)
|
||||
{
|
||||
return de_queue ( Serial_In_Queue );
|
||||
return de_queue(Serial_In_Queue);
|
||||
}
|
||||
|
||||
int ComSendString ( char *string )
|
||||
int ComSendString(
|
||||
char *string)
|
||||
{
|
||||
int retval;
|
||||
char *pointer;
|
||||
pointer = string;
|
||||
int retval;
|
||||
char *pointer;
|
||||
pointer = string;
|
||||
|
||||
while ( *pointer)
|
||||
{
|
||||
retval = en_queue ( Serial_Out_Queue, *pointer );
|
||||
pointer++;
|
||||
}
|
||||
if ( 0x0 == (comm_status.modem & 0x40))
|
||||
RaiseDtr ();
|
||||
outp ( ComBase + INT_EN, RX_INT | TBE_INT | ERR_INT | RS_INT );
|
||||
return retval;
|
||||
while (*pointer) {
|
||||
retval = en_queue(Serial_Out_Queue, *pointer);
|
||||
pointer++;
|
||||
}
|
||||
if (0x0 == (comm_status.modem & 0x40))
|
||||
RaiseDtr();
|
||||
outp(ComBase + INT_EN, RX_INT | TBE_INT | ERR_INT | RS_INT);
|
||||
return retval;
|
||||
}
|
||||
|
||||
int ComSendData ( char *buffer, unsigned buffer_length )
|
||||
int ComSendData(
|
||||
char *buffer,
|
||||
unsigned buffer_length)
|
||||
{
|
||||
int retval;
|
||||
char *pointer;
|
||||
pointer = buffer;
|
||||
unsigned i;
|
||||
int retval;
|
||||
char *pointer;
|
||||
pointer = buffer;
|
||||
unsigned i;
|
||||
|
||||
for (i = 0; i < buffer_length; i++)
|
||||
{
|
||||
retval = en_queue ( Serial_Out_Queue, *pointer );
|
||||
pointer++;
|
||||
}
|
||||
if ( 0x0 == (comm_status.modem & 0x40))
|
||||
RaiseDtr ();
|
||||
outp ( ComBase + INT_EN, RX_INT | TBE_INT | ERR_INT | RS_INT );
|
||||
return retval;
|
||||
for (i = 0; i < buffer_length; i++) {
|
||||
retval = en_queue(Serial_Out_Queue, *pointer);
|
||||
pointer++;
|
||||
}
|
||||
if (0x0 == (comm_status.modem & 0x40))
|
||||
RaiseDtr();
|
||||
outp(ComBase + INT_EN, RX_INT | TBE_INT | ERR_INT | RS_INT);
|
||||
return retval;
|
||||
}
|
||||
|
||||
int ComSendChar ( char character )
|
||||
int ComSendChar(
|
||||
char character)
|
||||
{
|
||||
int retval;
|
||||
int retval;
|
||||
|
||||
/* interrupt driven send */
|
||||
/* interrupt driven send */
|
||||
|
||||
if ( 0x0 == (comm_status.modem & 0x40))
|
||||
RaiseDtr ();
|
||||
retval = en_queue ( Serial_Out_Queue, character );
|
||||
if ( - 1 != retval)
|
||||
outp ( ComBase + INT_EN, RX_INT | TBE_INT | ERR_INT | RS_INT );
|
||||
return retval;
|
||||
if (0x0 == (comm_status.modem & 0x40))
|
||||
RaiseDtr();
|
||||
retval = en_queue(Serial_Out_Queue, character);
|
||||
if (-1 != retval)
|
||||
outp(ComBase + INT_EN, RX_INT | TBE_INT | ERR_INT | RS_INT);
|
||||
return retval;
|
||||
}
|
||||
|
||||
int ComStatus ( void )
|
||||
int ComStatus(
|
||||
void)
|
||||
{
|
||||
unsigned status;
|
||||
unsigned retval;
|
||||
unsigned status;
|
||||
unsigned retval;
|
||||
|
||||
retval = inp ( ComBase + LINE_STATUS );
|
||||
retval = retval << 8;
|
||||
status = inp ( ComBase + MODEM_STATUS );
|
||||
retval = retval | status;
|
||||
if ( queue_empty ( Serial_In_Queue ))
|
||||
retval &= 0xFEFF;
|
||||
else retval |= 0x0100;
|
||||
return (int) retval;
|
||||
retval = inp(ComBase + LINE_STATUS);
|
||||
retval = retval << 8;
|
||||
status = inp(ComBase + MODEM_STATUS);
|
||||
retval = retval | status;
|
||||
if (queue_empty(Serial_In_Queue))
|
||||
retval &= 0xFEFF;
|
||||
else
|
||||
retval |= 0x0100;
|
||||
return (int) retval;
|
||||
}
|
||||
|
||||
void INTERRUPT FAR serial ( void ) /* interrupt handler */
|
||||
{
|
||||
int temp;
|
||||
void INTERRUPT FAR serial(
|
||||
void)
|
||||
{ /* interrupt handler */
|
||||
int temp;
|
||||
|
||||
disable ();
|
||||
while ( 1)
|
||||
{
|
||||
comm_status.intrupt = inp ( ComBase + INT_ID );
|
||||
comm_status.intrupt &= 0x0f;
|
||||
switch ( comm_status.intrupt)
|
||||
{
|
||||
case 0x00: /* modem interrupt */
|
||||
comm_status.modem = inp( ComBase + MODEM_STATUS );
|
||||
break;
|
||||
disable();
|
||||
while (1) {
|
||||
comm_status.intrupt = inp(ComBase + INT_ID);
|
||||
comm_status.intrupt &= 0x0f;
|
||||
switch (comm_status.intrupt) {
|
||||
case 0x00: /* modem interrupt */
|
||||
comm_status.modem = inp(ComBase + MODEM_STATUS);
|
||||
break;
|
||||
|
||||
case 0x02: /* xmit interrupt */
|
||||
if ( queue_empty ( Serial_Out_Queue ))
|
||||
outp(ComBase + INT_EN, RX_INT|ERR_INT|RS_INT );
|
||||
else
|
||||
{
|
||||
temp = de_queue ( Serial_Out_Queue );
|
||||
if ( - 1 != temp)
|
||||
outp ( ComBase + XMIT, temp );
|
||||
}
|
||||
break;
|
||||
case 0x02: /* xmit interrupt */
|
||||
if (queue_empty(Serial_Out_Queue))
|
||||
outp(ComBase + INT_EN, RX_INT | ERR_INT | RS_INT);
|
||||
else {
|
||||
temp = de_queue(Serial_Out_Queue);
|
||||
if (-1 != temp)
|
||||
outp(ComBase + XMIT, temp);
|
||||
}
|
||||
break;
|
||||
|
||||
case 0x04: /* receive interrupt */
|
||||
en_queue(Serial_In_Queue, (char)inp(ComBase + REC));
|
||||
break;
|
||||
case 0x04: /* receive interrupt */
|
||||
en_queue(Serial_In_Queue, (char) inp(ComBase + REC));
|
||||
break;
|
||||
|
||||
case 0x06: /* line interrupt */
|
||||
comm_status.line = inp ( ComBase + LINE_STATUS );
|
||||
(void) inp ( ComBase + REC );
|
||||
en_queue ( Serial_In_Queue, '!' );
|
||||
break;
|
||||
case 0x06: /* line interrupt */
|
||||
comm_status.line = inp(ComBase + LINE_STATUS);
|
||||
(void) inp(ComBase + REC);
|
||||
en_queue(Serial_In_Queue, '!');
|
||||
break;
|
||||
|
||||
default: /* No Mo` Left */
|
||||
comm_status.modem = inp ( ComBase + MODEM_STATUS );
|
||||
outp ( 0x20, 0x20 );
|
||||
enable ();
|
||||
return;
|
||||
} /* switch */
|
||||
} /* while */
|
||||
default: /* No Mo` Left */
|
||||
comm_status.modem = inp(ComBase + MODEM_STATUS);
|
||||
outp(0x20, 0x20);
|
||||
enable();
|
||||
return;
|
||||
} /* switch */
|
||||
} /* while */
|
||||
}
|
||||
|
||||
/* End of Serial.C */
|
||||
|
||||
Reference in New Issue
Block a user