1 #define SD_JOURNAL_SUPPRESS_LOCATION
2
3 #include <systemd/sd-journal.h>
4 #include <unistd.h>
5
6 #include <phosphor-logging/lg2.hpp>
7
8 #include <algorithm>
9 #include <bitset>
10 #include <cstdarg>
11 #include <cstdio>
12 #include <iostream>
13 #include <mutex>
14 #include <source_location>
15 #include <sstream>
16 #include <vector>
17
18 namespace lg2::details
19 {
20 /** Convert unsigned to string using format flags. */
value_to_string(uint64_t f,uint64_t v)21 static std::string value_to_string(uint64_t f, uint64_t v)
22 {
23 switch (f & (hex | bin | dec).value)
24 {
25 // For binary, use bitset<>::to_string.
26 // Treat values without a field-length format flag as 64 bit.
27 case bin.value:
28 {
29 switch (f & (field8 | field16 | field32 | field64).value)
30 {
31 case field8.value:
32 {
33 return "0b" + std::bitset<8>(v).to_string();
34 }
35 case field16.value:
36 {
37 return "0b" + std::bitset<16>(v).to_string();
38 }
39 case field32.value:
40 {
41 return "0b" + std::bitset<32>(v).to_string();
42 }
43 case field64.value:
44 default:
45 {
46 return "0b" + std::bitset<64>(v).to_string();
47 }
48 }
49 }
50
51 // For hex, use the appropriate sprintf.
52 case hex.value:
53 {
54 char value[19];
55 const char* format = nullptr;
56
57 switch (f & (field8 | field16 | field32 | field64).value)
58 {
59 case field8.value:
60 {
61 format = "0x%02" PRIx64;
62 break;
63 }
64
65 case field16.value:
66 {
67 format = "0x%04" PRIx64;
68 break;
69 }
70
71 case field32.value:
72 {
73 format = "0x%08" PRIx64;
74 break;
75 }
76
77 case field64.value:
78 {
79 format = "0x%016" PRIx64;
80 break;
81 }
82
83 default:
84 {
85 format = "0x%" PRIx64;
86 break;
87 }
88 }
89
90 snprintf(value, sizeof(value), format, v);
91 return value;
92 }
93
94 // For dec, use the simple to_string.
95 case dec.value:
96 default:
97 {
98 return std::to_string(v);
99 }
100 }
101 }
102
103 /** Convert signed to string using format flags. */
value_to_string(uint64_t f,int64_t v)104 static std::string value_to_string(uint64_t f, int64_t v)
105 {
106 // If hex or bin was requested just use the unsigned formatting
107 // rules. (What should a negative binary number look like otherwise?)
108 if (f & (hex | bin).value)
109 {
110 return value_to_string(f, static_cast<uint64_t>(v));
111 }
112 return std::to_string(v);
113 }
114
115 /** Convert float to string using format flags. */
value_to_string(uint64_t,double v)116 static std::string value_to_string(uint64_t, double v)
117 {
118 // No format flags supported for floats.
119 return std::to_string(v);
120 }
121
122 // Positions of various strings in an iovec.
123 static constexpr size_t pos_msg = 0;
124 static constexpr size_t pos_fmtmsg = 1;
125 static constexpr size_t pos_prio = 2;
126 static constexpr size_t pos_file = 3;
127 static constexpr size_t pos_line = 4;
128 static constexpr size_t pos_func = 5;
129 static constexpr size_t static_locs = pos_func + 1;
130
131 /** No-op output of a message. */
noop_extra_output(level,const std::source_location &,const std::string &)132 static void noop_extra_output(level, const std::source_location&,
133 const std::string&)
134 {}
135
136 /** std::cerr output of a message. */
cerr_extra_output(level l,const std::source_location & s,const std::string & m)137 static void cerr_extra_output(level l, const std::source_location& s,
138 const std::string& m)
139 {
140 static const char* const defaultFormat = []() {
141 const char* f = getenv("LG2_FORMAT");
142 if (nullptr == f)
143 {
144 f = "<%l> %m";
145 }
146 return f;
147 }();
148
149 const char* format = defaultFormat;
150
151 std::stringstream stream;
152
153 while (*format)
154 {
155 if (*format != '%')
156 {
157 stream << *format;
158 ++format;
159 continue;
160 }
161
162 ++format;
163 switch (*format)
164 {
165 case '%':
166 case '\0':
167 stream << '%';
168 break;
169
170 case 'f':
171 stream << s.function_name();
172 break;
173
174 case 'F':
175 stream << s.file_name();
176 break;
177
178 case 'l':
179 stream << static_cast<uint64_t>(l);
180 break;
181
182 case 'L':
183 stream << s.line();
184 break;
185
186 case 'm':
187 stream << m;
188 break;
189
190 default:
191 stream << '%' << *format;
192 break;
193 }
194
195 if (*format != '\0')
196 {
197 ++format;
198 }
199 }
200
201 static std::mutex mutex;
202
203 // Prevent multiple threads from clobbering the stderr lines of each other
204 std::scoped_lock lock(mutex);
205
206 // Ensure this line makes it out before releasing mutex for next line
207 std::cerr << stream.str() << std::endl;
208 }
209
210 // Use the cerr output method if we are on a TTY or if explicitly set via
211 // environment variable.
212 static auto extra_output_method =
213 (isatty(fileno(stderr)) || nullptr != getenv("LG2_FORCE_STDERR"))
214 ? cerr_extra_output
215 : noop_extra_output;
216
217 // Do_log implementation.
do_log(level l,const std::source_location & s,const char * m,...)218 void do_log(level l, const std::source_location& s, const char* m, ...)
219 {
220 using namespace std::string_literals;
221
222 std::vector<std::string> strings{static_locs};
223
224 std::string message{m};
225
226 // Assign all the static fields.
227 strings[pos_fmtmsg] = "LOG2_FMTMSG="s + m;
228 strings[pos_prio] = "PRIORITY="s + std::to_string(static_cast<uint64_t>(l));
229 strings[pos_file] = "CODE_FILE="s + s.file_name();
230 strings[pos_line] = "CODE_LINE="s + std::to_string(s.line());
231 strings[pos_func] = "CODE_FUNC="s + s.function_name();
232
233 // Handle all the va_list args.
234 std::va_list args;
235 va_start(args, m);
236 while (true)
237 {
238 // Get the header out.
239 auto h_ptr = va_arg(args, const char*);
240 if (h_ptr == nullptr)
241 {
242 break;
243 }
244 std::string h{h_ptr};
245
246 // Get the format flag.
247 auto f = va_arg(args, uint64_t);
248
249 // Handle the value depending on which type format flag it has.
250 std::string value = {};
251 switch (f & (signed_val | unsigned_val | str | floating).value)
252 {
253 case signed_val.value:
254 {
255 auto v = va_arg(args, int64_t);
256 value = value_to_string(f, v);
257 break;
258 }
259
260 case unsigned_val.value:
261 {
262 auto v = va_arg(args, uint64_t);
263 value = value_to_string(f, v);
264 break;
265 }
266
267 case str.value:
268 {
269 value = va_arg(args, const char*);
270 break;
271 }
272
273 case floating.value:
274 {
275 auto v = va_arg(args, double);
276 value = value_to_string(f, v);
277 break;
278 }
279 }
280
281 // Create the field for this value.
282 strings.emplace_back(h + '=' + value);
283
284 // Check for {HEADER} in the message and replace with value.
285 auto h_brace = '{' + h + '}';
286 if (auto start = message.find(h_brace); start != std::string::npos)
287 {
288 message.replace(start, h_brace.size(), value);
289 }
290 }
291 va_end(args);
292
293 // Add the final message into the strings array.
294 strings[pos_msg] = "MESSAGE="s + message.data();
295
296 // Trasform strings -> iovec.
297 std::vector<iovec> iov{};
298 std::ranges::transform(strings, std::back_inserter(iov), [](auto& s) {
299 return iovec{s.data(), s.length()};
300 });
301
302 // Output the iovec.
303 sd_journal_sendv(iov.data(), strings.size());
304 extra_output_method(l, s, message);
305 }
306
307 } // namespace lg2::details
308