Desktop/xinu_mips-1.0.2.tar/xinu_mips-1.0.2/system/kprintf.c

Go to the documentation of this file.

/* Embedded XINU, Copyright (C) 2007.  All rights reserved. */

#include <kernel.h>
#include <vararg.h>
#include <device.h>
#include <stdio.h>
#include <uart.h>

syscall kputc(device *pdev, unsigned char c)
{
        int status, irmask;
        struct uart *puart;
        volatile struct uart_csreg *pucsr;

        if (NULL == pdev) { return SYSERR; }
        puart  = (struct uart *)pdev->controlblk;
        if (NULL == puart) { puart = &uarttab[0]; }
        pucsr = puart->csr;
        if (NULL == pucsr) { pucsr = (struct uart_csreg *)pdev->csr; }

        irmask = pucsr->ier;        /* Save UART interrupt state.   */
        pucsr->ier = 0;             /* Disable UART interrupts.     */

        do                               /* Wait for transmitter         */
        {
                status = pucsr->lsr;
        }
        while ( (status & UART_LSR_TEMT) !=  UART_LSR_TEMT );

/* Send character. */
        pucsr->thr = c;
        puart->cout++;

        pucsr->ier = irmask;        /* Restore UART interrupts.     */
        return c;
}

syscall kprintf(char *fmt, ...)
{
        va_list ap;

        va_start(ap, fmt);
        _doprnt(fmt, ap, (int (*)(int, int))kputc, (int)&devtab[SERIAL0]);
        va_end(ap);
        return OK;
}

---