jcs.org
Serenity Operating System
1/*
2 * Copyright (c) 2018-2020, Andreas Kling <kling@serenityos.org>
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 are met:
7 *
8 * 1. Redistributions of source code must retain the above copyright notice, this
9 * list of conditions and the following disclaimer.
10 *
11 * 2. Redistributions in binary form must reproduce the above copyright notice,
12 * this list of conditions and the following disclaimer in the documentation
13 * and/or other materials provided with the distribution.
14 *
15 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
16 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
17 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
18 * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE
19 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
20 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
21 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
22 * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
23 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
24 * OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
25 */
26
27#include <AK/PrintfImplementation.h>
28#include <AK/Types.h>
29#include <LibBareMetal/IO.h>
30#include <LibBareMetal/Output/Console.h>
31#include <LibBareMetal/Output/kstdio.h>
32
33#include <LibC/stdarg.h>
34
35#if defined(KERNEL)
36# include <Kernel/Process.h>
37#endif
38
39static bool serial_debug;
40
41void set_serial_debug(bool on_or_off)
42{
43 serial_debug = on_or_off;
44}
45
46int get_serial_debug()
47{
48 return serial_debug;
49}
50
51static void color_on()
52{
53 IO::out8(0xe9, 0x1b);
54 IO::out8(0xe9, '[');
55 IO::out8(0xe9, '3');
56 IO::out8(0xe9, '6');
57 IO::out8(0xe9, 'm');
58}
59
60static void color_off()
61{
62 IO::out8(0xe9, 0x1b);
63 IO::out8(0xe9, '[');
64 IO::out8(0xe9, '0');
65 IO::out8(0xe9, 'm');
66}
67
68static void serial_putch(char ch)
69{
70 static bool serial_ready = false;
71 static bool was_cr = false;
72
73 if (!serial_ready) {
74 IO::out8(0x3F8 + 1, 0x00);
75 IO::out8(0x3F8 + 3, 0x80);
76 IO::out8(0x3F8 + 0, 0x02);
77 IO::out8(0x3F8 + 1, 0x00);
78 IO::out8(0x3F8 + 3, 0x03);
79 IO::out8(0x3F8 + 2, 0xC7);
80 IO::out8(0x3F8 + 4, 0x0B);
81
82 serial_ready = true;
83 }
84
85 while ((IO::in8(0x3F8 + 5) & 0x20) == 0)
86 ;
87
88 if (ch == '\n' && !was_cr)
89 IO::out8(0x3F8, '\r');
90
91 IO::out8(0x3F8, ch);
92
93 if (ch == '\r')
94 was_cr = true;
95 else
96 was_cr = false;
97}
98
99static void console_out(char ch)
100{
101 if (serial_debug)
102 serial_putch(ch);
103
104 // It would be bad to reach the assert in Console()::the() and do a stack overflow
105
106 if (Console::is_initialized()) {
107 Console::the().put_char(ch);
108 } else {
109 IO::out8(0xe9, ch);
110 }
111}
112
113static void console_putch(char*&, char ch)
114{
115 console_out(ch);
116}
117
118int kprintf(const char* fmt, ...)
119{
120 color_on();
121 va_list ap;
122 va_start(ap, fmt);
123 int ret = printf_internal(console_putch, nullptr, fmt, ap);
124 va_end(ap);
125 color_off();
126 return ret;
127}
128
129static void buffer_putch(char*& bufptr, char ch)
130{
131 *bufptr++ = ch;
132}
133
134int sprintf(char* buffer, const char* fmt, ...)
135{
136 va_list ap;
137 va_start(ap, fmt);
138 int ret = printf_internal(buffer_putch, buffer, fmt, ap);
139 buffer[ret] = '\0';
140 va_end(ap);
141 return ret;
142}
143
144static void debugger_out(char ch)
145{
146 if (serial_debug)
147 serial_putch(ch);
148 IO::out8(0xe9, ch);
149}
150
151static void debugger_putch(char*&, char ch)
152{
153 debugger_out(ch);
154}
155
156extern "C" int dbgputstr(const char* characters, int length)
157{
158 if (!characters)
159 return 0;
160 for (int i = 0; i < length; ++i)
161 debugger_out(characters[i]);
162 return 0;
163}
164
165extern "C" int kernelputstr(const char* characters, int length)
166{
167 if (!characters)
168 return 0;
169 for (int i = 0; i < length; ++i)
170 console_out(characters[i]);
171 return 0;
172}
173
174extern "C" int dbgprintf(const char* fmt, ...)
175{
176 color_on();
177 va_list ap;
178 va_start(ap, fmt);
179 int ret = printf_internal(debugger_putch, nullptr, fmt, ap);
180 va_end(ap);
181 color_off();
182 return ret;
183}