printf.c
上传用户:lgb322
上传日期:2013-02-24
资源大小:30529k
文件大小:3k
源码类别:

嵌入式Linux

开发平台:

Unix_Linux

  1. /*
  2.  * Carsten Langgaard, carstenl@mips.com
  3.  * Copyright (C) 2000 MIPS Technologies, Inc.  All rights reserved.
  4.  *
  5.  * ########################################################################
  6.  *
  7.  *  This program is free software; you can distribute it and/or modify it
  8.  *  under the terms of the GNU General Public License (Version 2) as
  9.  *  published by the Free Software Foundation.
  10.  *
  11.  *  This program is distributed in the hope it will be useful, but WITHOUT
  12.  *  ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  13.  *  FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License
  14.  *  for more details.
  15.  *
  16.  *  You should have received a copy of the GNU General Public License along
  17.  *  with this program; if not, write to the Free Software Foundation, Inc.,
  18.  *  59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
  19.  *
  20.  * ########################################################################
  21.  *
  22.  * Putting things on the screen/serial line using YAMONs facilities.
  23.  *
  24.  */
  25. #include <linux/config.h>
  26. #include <linux/init.h>
  27. #include <linux/kernel.h>
  28. #include <linux/serialP.h>
  29. #include <linux/serial_reg.h>
  30. #include <asm/system.h>
  31. #include <asm/io.h>
  32. #include <asm/serial.h>
  33. #ifdef CONFIG_MIPS_ATLAS 
  34. /* 
  35.  * Atlas registers are memory mapped on 64-bit aligned boundaries and 
  36.  * only word access are allowed.
  37.  * When reading the UART 8 bit registers only the LSB are valid.
  38.  */
  39. unsigned int atlas_serial_in(struct async_struct *info, int offset)
  40. {
  41. return (*(volatile unsigned int *)(info->port + mips_io_port_base + offset*8) & 0xff);
  42. }
  43. void atlas_serial_out(struct async_struct *info, int offset, int value)
  44. {
  45. *(volatile unsigned int *)(info->port + mips_io_port_base + offset*8) = value;
  46. }
  47. #define serial_in  atlas_serial_in
  48. #define serial_out atlas_serial_out
  49. #else
  50. static unsigned int serial_in(struct async_struct *info, int offset)
  51. {
  52. return inb(info->port + offset);
  53. }
  54. static void serial_out(struct async_struct *info, int offset,
  55. int value)
  56. {
  57. outb(value, info->port + offset);
  58. }
  59. #endif
  60. static struct serial_state rs_table[] = {
  61. SERIAL_PORT_DFNS /* Defined in serial.h */
  62. };
  63. /*
  64.  * Hooks to fake "prom" console I/O before devices 
  65.  * are fully initialized. 
  66.  */
  67. static struct async_struct prom_port_info = {0};
  68. void __init setup_prom_printf(int tty_no) {
  69. struct serial_state *ser = &rs_table[tty_no];
  70. prom_port_info.state = ser;
  71. prom_port_info.magic = SERIAL_MAGIC;
  72. prom_port_info.port = ser->port;
  73. prom_port_info.flags = ser->flags;
  74. /* No setup of UART - assume YAMON left in sane state */
  75. }
  76. int putPromChar(char c)
  77. {
  78.         if (!prom_port_info.state) {  /* need to init device first */
  79. return 0;
  80. }
  81. while ((serial_in(&prom_port_info, UART_LSR) & UART_LSR_THRE) == 0)
  82. ;
  83. serial_out(&prom_port_info, UART_TX, c);
  84. return 1;
  85. }
  86. char getPromChar(void)
  87. {
  88. if (!prom_port_info.state) {  /* need to init device first */
  89. return 0;
  90. }
  91. while (!(serial_in(&prom_port_info, UART_LSR) & 1))
  92. ;
  93. return(serial_in(&prom_port_info, UART_RX));
  94. }
  95. static char buf[1024];
  96. void __init prom_printf(char *fmt, ...)
  97. {
  98. va_list args;
  99. int l;
  100. char *p, *buf_end;
  101. long flags;
  102. int putPromChar(char);
  103. /* Low level, brute force, not SMP safe... */
  104. save_and_cli(flags);
  105. va_start(args, fmt);
  106. l = vsprintf(buf, fmt, args); /* hopefully i < sizeof(buf) */
  107. va_end(args);
  108. buf_end = buf + l;
  109. for (p = buf; p < buf_end; p++) {
  110. /* Crude cr/nl handling is better than none */
  111. if(*p == 'n')putPromChar('r');
  112. putPromChar(*p);
  113. }
  114. restore_flags(flags);
  115. }