1 // SPDX-License-Identifier: GPL-2.0+
2 /*
3 * Logging support
4 *
5 * Copyright (c) 2017 Google, Inc
6 * Written by Simon Glass <sjg@chromium.org>
7 */
8
9 #include <common.h>
10 #include <display_options.h>
11 #include <log.h>
12 #include <malloc.h>
13 #include <asm/global_data.h>
14 #include <dm/uclass.h>
15
16 DECLARE_GLOBAL_DATA_PTR;
17
18 static const char *const log_cat_name[] = {
19 "none",
20 "arch",
21 "board",
22 "core",
23 "driver-model",
24 "device-tree",
25 "efi",
26 "alloc",
27 "sandbox",
28 "bloblist",
29 "devres",
30 "acpi",
31 "boot",
32 "event",
33 "fs",
34 };
35
36 _Static_assert(ARRAY_SIZE(log_cat_name) == LOGC_COUNT - LOGC_NONE,
37 "log_cat_name size");
38
39 static const char *const log_level_name[] = {
40 "EMERG",
41 "ALERT",
42 "CRIT",
43 "ERR",
44 "WARNING",
45 "NOTICE",
46 "INFO",
47 "DEBUG",
48 "CONTENT",
49 "IO",
50 };
51
52 _Static_assert(ARRAY_SIZE(log_level_name) == LOGL_COUNT, "log_level_name size");
53
54 /* All error responses MUST begin with '<' */
log_get_cat_name(enum log_category_t cat)55 const char *log_get_cat_name(enum log_category_t cat)
56 {
57 const char *name;
58
59 if (cat < 0 || cat >= LOGC_COUNT)
60 return "<invalid>";
61 if (cat >= LOGC_NONE)
62 return log_cat_name[cat - LOGC_NONE];
63
64 #if CONFIG_IS_ENABLED(DM)
65 name = uclass_get_name((enum uclass_id)cat);
66 #else
67 name = NULL;
68 #endif
69
70 return name ? name : "<missing>";
71 }
72
log_get_cat_by_name(const char * name)73 enum log_category_t log_get_cat_by_name(const char *name)
74 {
75 enum uclass_id id;
76 int i;
77
78 for (i = LOGC_NONE; i < LOGC_COUNT; i++)
79 if (!strcmp(name, log_cat_name[i - LOGC_NONE]))
80 return i;
81 id = uclass_get_by_name(name);
82 if (id != UCLASS_INVALID)
83 return (enum log_category_t)id;
84
85 return LOGC_NONE;
86 }
87
log_get_level_name(enum log_level_t level)88 const char *log_get_level_name(enum log_level_t level)
89 {
90 if (level >= LOGL_COUNT)
91 return "INVALID";
92 return log_level_name[level];
93 }
94
log_get_level_by_name(const char * name)95 enum log_level_t log_get_level_by_name(const char *name)
96 {
97 int i;
98
99 for (i = 0; i < LOGL_COUNT; i++) {
100 if (!strcasecmp(log_level_name[i], name))
101 return i;
102 }
103
104 return LOGL_NONE;
105 }
106
log_device_find_by_name(const char * drv_name)107 struct log_device *log_device_find_by_name(const char *drv_name)
108 {
109 struct log_device *ldev;
110
111 list_for_each_entry(ldev, &gd->log_head, sibling_node) {
112 if (!strcmp(drv_name, ldev->drv->name))
113 return ldev;
114 }
115
116 return NULL;
117 }
118
log_has_cat(enum log_category_t cat_list[],enum log_category_t cat)119 bool log_has_cat(enum log_category_t cat_list[], enum log_category_t cat)
120 {
121 int i;
122
123 for (i = 0; i < LOGF_MAX_CATEGORIES && cat_list[i] != LOGC_END; i++) {
124 if (cat_list[i] == cat)
125 return true;
126 }
127
128 return false;
129 }
130
log_has_file(const char * file_list,const char * file)131 bool log_has_file(const char *file_list, const char *file)
132 {
133 int file_len = strlen(file);
134 const char *s, *p;
135 int substr_len;
136
137 for (s = file_list; *s; s = p + (*p != '\0')) {
138 p = strchrnul(s, ',');
139 substr_len = p - s;
140 if (file_len >= substr_len &&
141 !strncmp(file + file_len - substr_len, s, substr_len))
142 return true;
143 }
144
145 return false;
146 }
147
148 /**
149 * log_passes_filters() - check if a log record passes the filters for a device
150 *
151 * @ldev: Log device to check
152 * @rec: Log record to check
153 * Return: true if @rec is not blocked by the filters in @ldev, false if it is
154 */
log_passes_filters(struct log_device * ldev,struct log_rec * rec)155 static bool log_passes_filters(struct log_device *ldev, struct log_rec *rec)
156 {
157 struct log_filter *filt;
158
159 if (rec->flags & LOGRECF_FORCE_DEBUG)
160 return true;
161
162 /* If there are no filters, filter on the default log level */
163 if (list_empty(&ldev->filter_head)) {
164 if (rec->level > gd->default_log_level)
165 return false;
166 return true;
167 }
168
169 list_for_each_entry(filt, &ldev->filter_head, sibling_node) {
170 if (filt->flags & LOGFF_LEVEL_MIN) {
171 if (rec->level < filt->level)
172 continue;
173 } else if (rec->level > filt->level) {
174 continue;
175 }
176
177 if ((filt->flags & LOGFF_HAS_CAT) &&
178 !log_has_cat(filt->cat_list, rec->cat))
179 continue;
180
181 if (filt->file_list &&
182 !log_has_file(filt->file_list, rec->file))
183 continue;
184
185 if (filt->flags & LOGFF_DENY)
186 return false;
187 else
188 return true;
189 }
190
191 return false;
192 }
193
194 /**
195 * log_dispatch() - Send a log record to all log devices for processing
196 *
197 * The log record is sent to each log device in turn, skipping those which have
198 * filters which block the record.
199 *
200 * All log messages created while processing log record @rec are ignored.
201 *
202 * @rec: log record to dispatch
203 * Return: 0 msg sent, 1 msg not sent while already dispatching another msg
204 */
log_dispatch(struct log_rec * rec,const char * fmt,va_list args)205 static int log_dispatch(struct log_rec *rec, const char *fmt, va_list args)
206 {
207 struct log_device *ldev;
208 char buf[CONFIG_SYS_CBSIZE];
209
210 /*
211 * When a log driver writes messages (e.g. via the network stack) this
212 * may result in further generated messages. We cannot process them here
213 * as this might result in infinite recursion.
214 */
215 if (gd->processing_msg)
216 return 1;
217
218 /* Emit message */
219 gd->processing_msg = true;
220 list_for_each_entry(ldev, &gd->log_head, sibling_node) {
221 if ((ldev->flags & LOGDF_ENABLE) &&
222 log_passes_filters(ldev, rec)) {
223 if (!rec->msg) {
224 int len;
225
226 len = vsnprintf(buf, sizeof(buf), fmt, args);
227 rec->msg = buf;
228 gd->log_cont = len && buf[len - 1] != '\n';
229 }
230 ldev->drv->emit(ldev, rec);
231 }
232 }
233 gd->processing_msg = false;
234 return 0;
235 }
236
_log(enum log_category_t cat,enum log_level_t level,const char * file,int line,const char * func,const char * fmt,...)237 int _log(enum log_category_t cat, enum log_level_t level, const char *file,
238 int line, const char *func, const char *fmt, ...)
239 {
240 struct log_rec rec;
241 va_list args;
242
243 if (!gd)
244 return -ENOSYS;
245
246 /* Check for message continuation */
247 if (cat == LOGC_CONT)
248 cat = gd->logc_prev;
249 if (level == LOGL_CONT)
250 level = gd->logl_prev;
251
252 rec.cat = cat;
253 rec.level = level & LOGL_LEVEL_MASK;
254 rec.flags = 0;
255 if (level & LOGL_FORCE_DEBUG)
256 rec.flags |= LOGRECF_FORCE_DEBUG;
257 if (gd->log_cont)
258 rec.flags |= LOGRECF_CONT;
259 rec.file = file;
260 rec.line = line;
261 rec.func = func;
262 rec.msg = NULL;
263
264 if (!(gd->flags & GD_FLG_LOG_READY)) {
265 gd->log_drop_count++;
266
267 /* display dropped traces with console puts and DEBUG_UART */
268 if (rec.level <= CONFIG_LOG_DEFAULT_LEVEL ||
269 rec.flags & LOGRECF_FORCE_DEBUG) {
270 char buf[CONFIG_SYS_CBSIZE];
271
272 va_start(args, fmt);
273 vsnprintf(buf, sizeof(buf), fmt, args);
274 puts(buf);
275 va_end(args);
276 }
277
278 return -ENOSYS;
279 }
280 va_start(args, fmt);
281 if (!log_dispatch(&rec, fmt, args)) {
282 gd->logc_prev = cat;
283 gd->logl_prev = level;
284 }
285 va_end(args);
286
287 return 0;
288 }
289
290 #define MAX_LINE_LENGTH_BYTES 64
291 #define DEFAULT_LINE_LENGTH_BYTES 16
292
_log_buffer(enum log_category_t cat,enum log_level_t level,const char * file,int line,const char * func,ulong addr,const void * data,uint width,uint count,uint linelen)293 int _log_buffer(enum log_category_t cat, enum log_level_t level,
294 const char *file, int line, const char *func, ulong addr,
295 const void *data, uint width, uint count, uint linelen)
296 {
297 if (linelen * width > MAX_LINE_LENGTH_BYTES)
298 linelen = MAX_LINE_LENGTH_BYTES / width;
299 if (linelen < 1)
300 linelen = DEFAULT_LINE_LENGTH_BYTES / width;
301
302 while (count) {
303 uint thislinelen;
304 char buf[HEXDUMP_MAX_BUF_LENGTH(width * linelen)];
305
306 thislinelen = hexdump_line(addr, data, width, count, linelen,
307 buf, sizeof(buf));
308 assert(thislinelen >= 0);
309 _log(cat, level, file, line, func, "%s\n", buf);
310
311 /* update references */
312 data += thislinelen * width;
313 addr += thislinelen * width;
314 count -= thislinelen;
315 }
316
317 return 0;
318 }
319
log_add_filter_flags(const char * drv_name,enum log_category_t cat_list[],enum log_level_t level,const char * file_list,int flags)320 int log_add_filter_flags(const char *drv_name, enum log_category_t cat_list[],
321 enum log_level_t level, const char *file_list,
322 int flags)
323 {
324 struct log_filter *filt;
325 struct log_device *ldev;
326 int ret;
327 int i;
328
329 ldev = log_device_find_by_name(drv_name);
330 if (!ldev)
331 return -ENOENT;
332 filt = calloc(1, sizeof(*filt));
333 if (!filt)
334 return -ENOMEM;
335
336 filt->flags = flags;
337 if (cat_list) {
338 filt->flags |= LOGFF_HAS_CAT;
339 for (i = 0; ; i++) {
340 if (i == ARRAY_SIZE(filt->cat_list)) {
341 ret = -ENOSPC;
342 goto err;
343 }
344 filt->cat_list[i] = cat_list[i];
345 if (cat_list[i] == LOGC_END)
346 break;
347 }
348 }
349 filt->level = level;
350 if (file_list) {
351 filt->file_list = strdup(file_list);
352 if (!filt->file_list) {
353 ret = -ENOMEM;
354 goto err;
355 }
356 }
357 filt->filter_num = ldev->next_filter_num++;
358 /* Add deny filters to the beginning of the list */
359 if (flags & LOGFF_DENY)
360 list_add(&filt->sibling_node, &ldev->filter_head);
361 else
362 list_add_tail(&filt->sibling_node, &ldev->filter_head);
363
364 return filt->filter_num;
365
366 err:
367 free(filt);
368 return ret;
369 }
370
log_remove_filter(const char * drv_name,int filter_num)371 int log_remove_filter(const char *drv_name, int filter_num)
372 {
373 struct log_filter *filt;
374 struct log_device *ldev;
375
376 ldev = log_device_find_by_name(drv_name);
377 if (!ldev)
378 return -ENOENT;
379
380 list_for_each_entry(filt, &ldev->filter_head, sibling_node) {
381 if (filt->filter_num == filter_num) {
382 list_del(&filt->sibling_node);
383 free(filt);
384
385 return 0;
386 }
387 }
388
389 return -ENOENT;
390 }
391
392 /**
393 * log_find_device_by_drv() - Find a device by its driver
394 *
395 * @drv: Log driver
396 * Return: Device associated with that driver, or NULL if not found
397 */
log_find_device_by_drv(struct log_driver * drv)398 static struct log_device *log_find_device_by_drv(struct log_driver *drv)
399 {
400 struct log_device *ldev;
401
402 list_for_each_entry(ldev, &gd->log_head, sibling_node) {
403 if (ldev->drv == drv)
404 return ldev;
405 }
406 /*
407 * It is quite hard to pass an invalid driver since passing an unknown
408 * LOG_GET_DRIVER(xxx) would normally produce a compilation error. But
409 * it is possible to pass NULL, for example, so this
410 */
411
412 return NULL;
413 }
414
log_device_set_enable(struct log_driver * drv,bool enable)415 int log_device_set_enable(struct log_driver *drv, bool enable)
416 {
417 struct log_device *ldev;
418
419 ldev = log_find_device_by_drv(drv);
420 if (!ldev)
421 return -ENOENT;
422 if (enable)
423 ldev->flags |= LOGDF_ENABLE;
424 else
425 ldev->flags &= ~LOGDF_ENABLE;
426
427 return 0;
428 }
429
log_init(void)430 int log_init(void)
431 {
432 struct log_driver *drv = ll_entry_start(struct log_driver, log_driver);
433 const int count = ll_entry_count(struct log_driver, log_driver);
434 struct log_driver *end = drv + count;
435
436 /*
437 * We cannot add runtime data to the driver since it is likely stored
438 * in rodata. Instead, set up a 'device' corresponding to each driver.
439 * We only support having a single device.
440 */
441 INIT_LIST_HEAD((struct list_head *)&gd->log_head);
442 while (drv < end) {
443 struct log_device *ldev;
444
445 ldev = calloc(1, sizeof(*ldev));
446 if (!ldev) {
447 debug("%s: Cannot allocate memory\n", __func__);
448 return -ENOMEM;
449 }
450 INIT_LIST_HEAD(&ldev->filter_head);
451 ldev->drv = drv;
452 ldev->flags = drv->flags;
453 list_add_tail(&ldev->sibling_node,
454 (struct list_head *)&gd->log_head);
455 drv++;
456 }
457 gd->flags |= GD_FLG_LOG_READY;
458 if (!gd->default_log_level)
459 gd->default_log_level = CONFIG_LOG_DEFAULT_LEVEL;
460 gd->log_fmt = log_get_default_format();
461 gd->logc_prev = LOGC_NONE;
462 gd->logl_prev = LOGL_INFO;
463
464 return 0;
465 }
466