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