RTOS/rtems
1
0
Fork 0
forked from Imagelibrary/rtems
Code Pull Requests Activity

libchip/serial/ns16550.c: Transmit the character in the polled write

Browse Source 
function within a critical section for printk() compatibility.
This commit is contained in:
Thomas Doerfler
2008-11-18 09:20:18 +00:00
parent 1e0f03b529
commit 9151ec6763
2 changed files with 33 additions and 33 deletions
Download Patch File Download Diff File Expand all files Collapse all files

5
c/src/ChangeLog
View File

@@ -1,3 +1,8 @@
2008-11-13 Sebastian Huber <sebastian.huber@embedded-brains.de>
* libchip/serial/ns16550.c: Transmit the character in the polled write
function within a critical section for printk() compatibility.
2008-10-02 Sebastian Huber <sebastian.huber@embedded-brains.de>
* libchip/i2c/spi-sd-card.c: Update for status-checks.h changes.

61
c/src/libchip/serial/ns16550.c
View File

@@ -196,44 +196,39 @@ NS16550_STATIC int ns16550_close(
return(RTEMS_SUCCESSFUL);
}
/*
* ns16550_write_polled
/**
* @brief Polled write for NS16550.
*/
NS16550_STATIC void ns16550_write_polled(
int minor,
char cChar
)
NS16550_STATIC void ns16550_write_polled( int minor, char c)
{
uint32_t pNS16550;
unsigned char ucLineStatus;
getRegister_f getReg;
setRegister_f setReg;
uint32_t port = Console_Port_Tbl [minor].ulCtrlPort1;
getRegister_f get = Console_Port_Tbl [minor].getRegister;
setRegister_f set = Console_Port_Tbl [minor].setRegister;
uint32_t status;
rtems_interrupt_level level;
pNS16550 = Console_Port_Tbl[minor].ulCtrlPort1;
getReg = Console_Port_Tbl[minor].getRegister;
setReg = Console_Port_Tbl[minor].setRegister;
while (1) {
/* Try to transmit the character in a critical section */
rtems_interrupt_disable( level);
/*
* wait for transmitter holding register to be empty
*/
ucLineStatus = (*getReg)(pNS16550, NS16550_LINE_STATUS);
while ((ucLineStatus & SP_LSR_THOLD) == 0) {
/*
* Yield while we wait
*/
#if 0
if(_System_state_Is_up(_System_state_Get())) {
rtems_task_wake_after(RTEMS_YIELD_PROCESSOR);
}
#endif
ucLineStatus = (*getReg)(pNS16550, NS16550_LINE_STATUS);
/* Read the transmitter holding register and check it */
status = get( port, NS16550_LINE_STATUS);
if ((status & SP_LSR_THOLD) != 0) {
/* Transmit character */
set( port, NS16550_TRANSMIT_BUFFER, c);
/* Finished */
rtems_interrupt_enable( level);
break;
} else {
rtems_interrupt_enable( level);
}
/* Wait for transmitter holding register to be empty */
do {
status = get( port, NS16550_LINE_STATUS);
} while ((status & SP_LSR_THOLD) == 0);
}
/*
* transmit character
*/
(*setReg)(pNS16550, NS16550_TRANSMIT_BUFFER, cChar);
}
/*