Use __DEQUALIFY, not only __DECONST to get rid of the volatile too.
[dragonfly.git] / sys / boot / ofw / libofw / ofw_console.c
1 /*
2  * $NetBSD: prom.c,v 1.3 1997/09/06 14:03:58 drochner Exp $
3  * $FreeBSD: src/sys/boot/ofw/libofw/ofw_console.c,v 1.7 2002/02/23 04:33:15 jake Exp $
4  * $DragonFly: src/sys/boot/ofw/libofw/ofw_console.c,v 1.1 2003/11/10 06:08:37 dillon Exp $
5  */
6
7 /*  
8  * Mach Operating System
9  * Copyright (c) 1992 Carnegie Mellon University
10  * All Rights Reserved.
11  * 
12  * Permission to use, copy, modify and distribute this software and its
13  * documentation is hereby granted, provided that both the copyright
14  * notice and this permission notice appear in all copies of the
15  * software, derivative works or modified versions, and any portions
16  * thereof, and that both notices appear in supporting documentation.
17  * 
18  * CARNEGIE MELLON ALLOWS FREE USE OF THIS SOFTWARE IN ITS "AS IS"
19  * CONDITION.  CARNEGIE MELLON DISCLAIMS ANY LIABILITY OF ANY KIND FOR
20  * ANY DAMAGES WHATSOEVER RESULTING FROM THE USE OF THIS SOFTWARE.
21  * 
22  * Carnegie Mellon requests users of this software to return to
23  * 
24  *  Software Distribution Coordinator  or  Software.Distribution@CS.CMU.EDU
25  *  School of Computer Science
26  *  Carnegie Mellon University
27  *  Pittsburgh PA 15213-3890
28  * 
29  * any improvements or extensions that they make and grant Carnegie Mellon
30  * the rights to redistribute these changes.
31  */
32
33 #include <sys/types.h>
34
35 #include "bootstrap.h"
36 #include "openfirm.h"
37
38 int console;
39
40 static void ofw_cons_probe(struct console *cp);
41 static int ofw_cons_init(int);
42 void ofw_cons_putchar(int);
43 int ofw_cons_getchar(void);
44 int ofw_cons_poll(void);
45
46 static ihandle_t stdin;
47 static ihandle_t stdout;
48
49 struct console ofwconsole = {
50         "ofw",
51         "OpenFirmware console",
52         0,
53         ofw_cons_probe,
54         ofw_cons_init,
55         ofw_cons_putchar,
56         ofw_cons_getchar,
57         ofw_cons_poll,
58 };
59
60 static void
61 ofw_cons_probe(struct console *cp)
62 {
63         phandle_t chosen;
64
65         if ((chosen = OF_finddevice("/chosen")) == -1)
66                 OF_exit();
67         OF_getprop(chosen, "stdin", &stdin, sizeof(stdin));
68         OF_getprop(chosen, "stdout", &stdout, sizeof(stdout));
69         cp->c_flags |= C_PRESENTIN|C_PRESENTOUT;
70 }
71
72 static int
73 ofw_cons_init(int arg)
74 {
75         return 0;
76 }
77
78 void
79 ofw_cons_putchar(int c)
80 {
81         char cbuf;
82
83         if (c == '\n') {
84                 cbuf = '\r';
85                 OF_write(stdout, &cbuf, 1);
86         }
87
88         cbuf = c;
89         OF_write(stdout, &cbuf, 1);
90 }
91
92 static int saved_char = -1;
93
94 int
95 ofw_cons_getchar()
96 {
97         unsigned char ch = '\0';
98         int l;
99
100         if (saved_char != -1) {
101                 l = saved_char;
102                 saved_char = -1;
103                 return l;
104         }
105
106         while ((l = OF_read(stdin, &ch, 1)) != 1)
107                 if (l != -2 && l != 0)
108                         return -1;
109         return ch;
110 }
111
112 int
113 ofw_cons_poll()
114 {
115         unsigned char ch;
116         int l;
117
118         if (saved_char != -1)
119                 return 1;
120
121         if (OF_read(stdin, &ch, 1) > 0) {
122                 saved_char = ch;
123                 return 1;
124         }
125
126         return 0;
127 }