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