root / prex-0.9.0 / bsp / hal / ppc / prep / diag.c @ 03e9c04a
History | View | Annotate | Download (2.4 KB)
1 |
/*-
|
---|---|
2 |
* Copyright (c) 2009, Kohsuke Ohtani
|
3 |
* All rights reserved.
|
4 |
*
|
5 |
* Redistribution and use in source and binary forms, with or without
|
6 |
* modification, are permitted provided that the following conditions
|
7 |
* are met:
|
8 |
* 1. Redistributions of source code must retain the above copyright
|
9 |
* notice, this list of conditions and the following disclaimer.
|
10 |
* 2. Redistributions in binary form must reproduce the above copyright
|
11 |
* notice, this list of conditions and the following disclaimer in the
|
12 |
* documentation and/or other materials provided with the distribution.
|
13 |
* 3. Neither the name of the author nor the names of any co-contributors
|
14 |
* may be used to endorse or promote products derived from this software
|
15 |
* without specific prior written permission.
|
16 |
*
|
17 |
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
|
18 |
* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
|
19 |
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
|
20 |
* ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
|
21 |
* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
|
22 |
* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
|
23 |
* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
|
24 |
* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
|
25 |
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
|
26 |
* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
|
27 |
* SUCH DAMAGE.
|
28 |
*/
|
29 |
|
30 |
/*
|
31 |
* diag.c - diagnostic message support
|
32 |
*/
|
33 |
|
34 |
#include <sys/bootinfo.h> |
35 |
#include <kernel.h> |
36 |
#include <cpufunc.h> |
37 |
#include <io.h> |
38 |
|
39 |
#ifdef CONFIG_DIAG_SERIAL
|
40 |
|
41 |
#define COM_BASE CONFIG_NS16550_BASE
|
42 |
#define COM_THR (COM_BASE + 0x00) /* transmit holding register */ |
43 |
#define COM_LSR (COM_BASE + 0x05) /* line status register */ |
44 |
|
45 |
static void |
46 |
serial_putc(char c)
|
47 |
{ |
48 |
|
49 |
while (!(inb(COM_LSR) & 0x20)) |
50 |
; |
51 |
outb(COM_THR, c); |
52 |
} |
53 |
|
54 |
void
|
55 |
diag_puts(char *str)
|
56 |
{ |
57 |
|
58 |
while (*str) {
|
59 |
if (*str == '\n') |
60 |
serial_putc('\r');
|
61 |
serial_putc(*str++); |
62 |
} |
63 |
} |
64 |
|
65 |
/*
|
66 |
* We assume the serial port has already been initialized by
|
67 |
* the boot loader.
|
68 |
*/
|
69 |
void
|
70 |
diag_init(void)
|
71 |
{ |
72 |
/* DO NOTHING */
|
73 |
} |
74 |
#endif /* !CONFIG_DIAG_SERIAL */ |
75 |
|
76 |
#ifdef CONFIG_DIAG_QEMU
|
77 |
void
|
78 |
diag_puts(char *str)
|
79 |
{ |
80 |
|
81 |
while (*str) {
|
82 |
/* Write to the qemu debug port. */
|
83 |
outb(0xf00, (u_char)*str++);
|
84 |
} |
85 |
} |
86 |
|
87 |
void
|
88 |
diag_init(void)
|
89 |
{ |
90 |
} |
91 |
#endif /* !CONFIG_DIAG_QEMU */ |