1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
|
/* IBM_PROLOG_BEGIN_TAG */
/* This is an automatically generated prolog. */
/* */
/* $Source: src/usr/console/console.C $ */
/* */
/* OpenPOWER HostBoot Project */
/* */
/* Contributors Listed Below - COPYRIGHT 2014 */
/* [+] Google Inc. */
/* [+] International Business Machines Corp. */
/* */
/* */
/* Licensed under the Apache License, Version 2.0 (the "License"); */
/* you may not use this file except in compliance with the License. */
/* You may obtain a copy of the License at */
/* */
/* http://www.apache.org/licenses/LICENSE-2.0 */
/* */
/* Unless required by applicable law or agreed to in writing, software */
/* distributed under the License is distributed on an "AS IS" BASIS, */
/* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or */
/* implied. See the License for the specific language governing */
/* permissions and limitations under the License. */
/* */
/* IBM_PROLOG_END_TAG */
#include <console/consoleif.H>
#include <util/sprintf.H>
#include <sys/msg.h>
#include <stdio.h>
#include <string.h>
#include <time.h>
#include <vector>
#include "daemon.H"
namespace CONSOLE
{
msg_q_t g_msgq = msg_q_create();
void display(const char* str)
{
timespec_t time;
clock_gettime(CLOCK_MONOTONIC, &time);
msg_t* msg = msg_allocate();
msg->type = DISPLAY;
msg->data[0] = time.tv_sec;
msg->data[1] = time.tv_nsec;
msg->extra_data = strdup(str);
msg_send(g_msgq, msg);
}
void displayf(const char* header, const char* format, ...)
{
va_list args;
va_start(args, format);
vdisplayf(header, format, args);
va_end(args);
}
void vdisplayf(const char* header, const char* format, va_list args)
{
using Util::vasprintf;
class OutputBuffer : public Util::ConsoleBufferInterface
{
public:
OutputBuffer() { str.reserve(64); }
int putc(int c)
{
str.push_back(c);
return c;
}
size_t operator()(int c) { return putc(c); }
std::vector<char> str;
};
OutputBuffer b;
if (header)
{
while(*header)
{
b.putc(*header);
header++;
}
b.putc('|');
}
vasprintf(b, format, args);
b.putc('\n');
b.putc('\0');
if (b.str.size())
{
display(&b.str[0]);
}
}
void flush()
{
msg_t* msg = msg_allocate();
msg->type = SYNC;
msg_sendrecv(g_msgq, msg);
// Always free since send/recv implies ownership
msg_free(msg);
msg=nullptr;
}
}
|
