Linux Audio

Check our new training course

Loading...
v3.15
 
  1/*
  2 * Persistent Storage - platform driver interface parts.
  3 *
  4 * Copyright (C) 2007-2008 Google, Inc.
  5 * Copyright (C) 2010 Intel Corporation <tony.luck@intel.com>
  6 *
  7 *  This program is free software; you can redistribute it and/or modify
  8 *  it under the terms of the GNU General Public License version 2 as
  9 *  published by the Free Software Foundation.
 10 *
 11 *  This program is distributed in the hope that it will be useful,
 12 *  but WITHOUT ANY WARRANTY; without even the implied warranty of
 13 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 14 *  GNU General Public License for more details.
 15 *
 16 *  You should have received a copy of the GNU General Public License
 17 *  along with this program; if not, write to the Free Software
 18 *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
 19 */
 20
 
 
 21#include <linux/atomic.h>
 22#include <linux/types.h>
 23#include <linux/errno.h>
 24#include <linux/init.h>
 25#include <linux/kmsg_dump.h>
 26#include <linux/console.h>
 
 27#include <linux/module.h>
 28#include <linux/pstore.h>
 29#include <linux/zlib.h>
 30#include <linux/string.h>
 31#include <linux/timer.h>
 32#include <linux/slab.h>
 33#include <linux/uaccess.h>
 34#include <linux/hardirq.h>
 35#include <linux/jiffies.h>
 
 36#include <linux/workqueue.h>
 
 37
 38#include "internal.h"
 39
 40/*
 41 * We defer making "oops" entries appear in pstore - see
 42 * whether the system is actually still running well enough
 43 * to let someone see the entry
 44 */
 45static int pstore_update_ms = -1;
 46module_param_named(update_ms, pstore_update_ms, int, 0600);
 47MODULE_PARM_DESC(update_ms, "milliseconds before pstore updates its content "
 48		 "(default is -1, which means runtime updates are disabled; "
 49		 "enabling this option is not safe, it may lead to further "
 50		 "corruption on Oopses)");
 51
 
 
 
 
 
 
 
 
 
 
 
 
 
 52static int pstore_new_entry;
 53
 54static void pstore_timefunc(unsigned long);
 55static DEFINE_TIMER(pstore_timer, pstore_timefunc, 0, 0);
 56
 57static void pstore_dowork(struct work_struct *);
 58static DECLARE_WORK(pstore_work, pstore_dowork);
 59
 60/*
 61 * pstore_lock just protects "psinfo" during
 62 * calls to pstore_register()
 
 63 */
 64static DEFINE_SPINLOCK(pstore_lock);
 65struct pstore_info *psinfo;
 66
 67static char *backend;
 
 
 68
 69/* Compression parameters */
 70#define COMPR_LEVEL 6
 71#define WINDOW_BITS 12
 72#define MEM_LEVEL 4
 73static struct z_stream_s stream;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 74
 75static char *big_oops_buf;
 76static size_t big_oops_buf_sz;
 
 
 
 
 
 77
 78/* How much of the console log to snapshot */
 79static unsigned long kmsg_bytes = 10240;
 80
 81void pstore_set_kmsg_bytes(int bytes)
 82{
 83	kmsg_bytes = bytes;
 84}
 85
 86/* Tag each group of saved records with a sequence number */
 87static int	oopscount;
 88
 89static const char *get_reason_str(enum kmsg_dump_reason reason)
 90{
 91	switch (reason) {
 92	case KMSG_DUMP_PANIC:
 93		return "Panic";
 94	case KMSG_DUMP_OOPS:
 95		return "Oops";
 96	case KMSG_DUMP_EMERG:
 97		return "Emergency";
 98	case KMSG_DUMP_RESTART:
 99		return "Restart";
100	case KMSG_DUMP_HALT:
101		return "Halt";
102	case KMSG_DUMP_POWEROFF:
103		return "Poweroff";
104	default:
105		return "Unknown";
 
106	}
 
 
 
 
 
 
 
 
 
 
 
107}
108
109bool pstore_cannot_block_path(enum kmsg_dump_reason reason)
110{
111	/*
112	 * In case of NMI path, pstore shouldn't be blocked
113	 * regardless of reason.
114	 */
115	if (in_nmi())
116		return true;
117
118	switch (reason) {
119	/* In panic case, other cpus are stopped by smp_send_stop(). */
120	case KMSG_DUMP_PANIC:
121	/* Emergency restart shouldn't be blocked by spin lock. */
 
 
 
122	case KMSG_DUMP_EMERG:
123		return true;
124	default:
125		return false;
126	}
127}
128EXPORT_SYMBOL_GPL(pstore_cannot_block_path);
129
130/* Derived from logfs_compress() */
131static int pstore_compress(const void *in, void *out, size_t inlen,
132							size_t outlen)
133{
134	int err, ret;
135
136	ret = -EIO;
137	err = zlib_deflateInit2(&stream, COMPR_LEVEL, Z_DEFLATED, WINDOW_BITS,
138						MEM_LEVEL, Z_DEFAULT_STRATEGY);
139	if (err != Z_OK)
140		goto error;
141
142	stream.next_in = in;
143	stream.avail_in = inlen;
144	stream.total_in = 0;
145	stream.next_out = out;
146	stream.avail_out = outlen;
147	stream.total_out = 0;
148
149	err = zlib_deflate(&stream, Z_FINISH);
150	if (err != Z_STREAM_END)
151		goto error;
152
153	err = zlib_deflateEnd(&stream);
154	if (err != Z_OK)
155		goto error;
156
157	if (stream.total_out >= stream.total_in)
158		goto error;
159
160	ret = stream.total_out;
161error:
162	return ret;
163}
164
165/* Derived from logfs_uncompress */
166static int pstore_decompress(void *in, void *out, size_t inlen, size_t outlen)
167{
168	int err, ret;
169
170	ret = -EIO;
171	err = zlib_inflateInit2(&stream, WINDOW_BITS);
172	if (err != Z_OK)
173		goto error;
174
175	stream.next_in = in;
176	stream.avail_in = inlen;
177	stream.total_in = 0;
178	stream.next_out = out;
179	stream.avail_out = outlen;
180	stream.total_out = 0;
181
182	err = zlib_inflate(&stream, Z_FINISH);
183	if (err != Z_STREAM_END)
184		goto error;
185
186	err = zlib_inflateEnd(&stream);
187	if (err != Z_OK)
188		goto error;
189
190	ret = stream.total_out;
191error:
192	return ret;
193}
194
195static void allocate_buf_for_compression(void)
196{
197	size_t size;
198	size_t cmpr;
199
200	switch (psinfo->bufsize) {
201	/* buffer range for efivars */
202	case 1000 ... 2000:
203		cmpr = 56;
204		break;
205	case 2001 ... 3000:
206		cmpr = 54;
207		break;
208	case 3001 ... 3999:
209		cmpr = 52;
210		break;
211	/* buffer range for nvram, erst */
212	case 4000 ... 10000:
213		cmpr = 45;
214		break;
215	default:
216		cmpr = 60;
217		break;
218	}
219
220	big_oops_buf_sz = (psinfo->bufsize * 100) / cmpr;
221	big_oops_buf = kmalloc(big_oops_buf_sz, GFP_KERNEL);
222	if (big_oops_buf) {
223		size = max(zlib_deflate_workspacesize(WINDOW_BITS, MEM_LEVEL),
224			zlib_inflate_workspacesize());
225		stream.workspace = kmalloc(size, GFP_KERNEL);
226		if (!stream.workspace) {
227			pr_err("pstore: No memory for compression workspace; "
228				"skipping compression\n");
229			kfree(big_oops_buf);
230			big_oops_buf = NULL;
231		}
232	} else {
233		pr_err("No memory for uncompressed data; "
234			"skipping compression\n");
235		stream.workspace = NULL;
 
 
 
 
 
 
 
 
 
236	}
237
 
 
 
 
 
238}
239
240/*
241 * Called when compression fails, since the printk buffer
242 * would be fetched for compression calling it again when
243 * compression fails would have moved the iterator of
244 * printk buffer which results in fetching old contents.
245 * Copy the recent messages from big_oops_buf to psinfo->buf
246 */
247static size_t copy_kmsg_to_buffer(int hsize, size_t len)
248{
249	size_t total_len;
250	size_t diff;
 
 
251
252	total_len = hsize + len;
 
 
 
 
 
 
 
 
253
254	if (total_len > psinfo->bufsize) {
255		diff = total_len - psinfo->bufsize + hsize;
256		memcpy(psinfo->buf, big_oops_buf, hsize);
257		memcpy(psinfo->buf + hsize, big_oops_buf + diff,
258					psinfo->bufsize - hsize);
259		total_len = psinfo->bufsize;
260	} else
261		memcpy(psinfo->buf, big_oops_buf, total_len);
262
263	return total_len;
 
264}
265
266/*
267 * callback from kmsg_dump. (s2,l2) has the most recently
268 * written bytes, older bytes are in (s1,l1). Save as much
269 * as we can from the end of the buffer.
270 */
271static void pstore_dump(struct kmsg_dumper *dumper,
272			enum kmsg_dump_reason reason)
273{
 
274	unsigned long	total = 0;
275	const char	*why;
276	u64		id;
277	unsigned int	part = 1;
278	unsigned long	flags = 0;
279	int		is_locked = 0;
280	int		ret;
281
282	why = get_reason_str(reason);
283
284	if (pstore_cannot_block_path(reason)) {
285		is_locked = spin_trylock_irqsave(&psinfo->buf_lock, flags);
286		if (!is_locked) {
287			pr_err("pstore dump routine blocked in %s path, may corrupt error record\n"
288				       , in_nmi() ? "NMI" : why);
289		}
290	} else
291		spin_lock_irqsave(&psinfo->buf_lock, flags);
 
 
 
 
292	oopscount++;
293	while (total < kmsg_bytes) {
294		char *dst;
295		unsigned long size;
296		int hsize;
297		int zipped_len = -1;
298		size_t len;
299		bool compressed;
300		size_t total_len;
301
302		if (big_oops_buf) {
303			dst = big_oops_buf;
304			hsize = sprintf(dst, "%s#%d Part%d\n", why,
305							oopscount, part);
306			size = big_oops_buf_sz - hsize;
307
308			if (!kmsg_dump_get_buffer(dumper, true, dst + hsize,
309								size, &len))
310				break;
 
 
 
 
 
 
 
 
 
 
311
 
312			zipped_len = pstore_compress(dst, psinfo->buf,
313						hsize + len, psinfo->bufsize);
 
314
315			if (zipped_len > 0) {
316				compressed = true;
317				total_len = zipped_len;
318			} else {
319				compressed = false;
320				total_len = copy_kmsg_to_buffer(hsize, len);
 
 
 
 
 
 
 
321			}
322		} else {
323			dst = psinfo->buf;
324			hsize = sprintf(dst, "%s#%d Part%d\n", why, oopscount,
325									part);
326			size = psinfo->bufsize - hsize;
327			dst += hsize;
328
329			if (!kmsg_dump_get_buffer(dumper, true, dst,
330								size, &len))
331				break;
332
333			compressed = false;
334			total_len = hsize + len;
335		}
336
337		ret = psinfo->write(PSTORE_TYPE_DMESG, reason, &id, part,
338				    oopscount, compressed, total_len, psinfo);
339		if (ret == 0 && reason == KMSG_DUMP_OOPS && pstore_is_mounted())
340			pstore_new_entry = 1;
 
 
 
 
 
 
341
342		total += total_len;
343		part++;
344	}
345	if (pstore_cannot_block_path(reason)) {
346		if (is_locked)
347			spin_unlock_irqrestore(&psinfo->buf_lock, flags);
348	} else
349		spin_unlock_irqrestore(&psinfo->buf_lock, flags);
 
350}
351
352static struct kmsg_dumper pstore_dumper = {
353	.dump = pstore_dump,
354};
355
 
 
 
 
 
 
 
 
 
 
 
 
 
356#ifdef CONFIG_PSTORE_CONSOLE
357static void pstore_console_write(struct console *con, const char *s, unsigned c)
358{
359	const char *e = s + c;
360
361	while (s < e) {
362		unsigned long flags;
363		u64 id;
364
365		if (c > psinfo->bufsize)
366			c = psinfo->bufsize;
367
368		if (oops_in_progress) {
369			if (!spin_trylock_irqsave(&psinfo->buf_lock, flags))
370				break;
371		} else {
372			spin_lock_irqsave(&psinfo->buf_lock, flags);
373		}
374		memcpy(psinfo->buf, s, c);
375		psinfo->write(PSTORE_TYPE_CONSOLE, 0, &id, 0, 0, 0, c, psinfo);
376		spin_unlock_irqrestore(&psinfo->buf_lock, flags);
377		s += c;
378		c = e - s;
379	}
380}
381
382static struct console pstore_console = {
383	.name	= "pstore",
384	.write	= pstore_console_write,
385	.flags	= CON_PRINTBUFFER | CON_ENABLED | CON_ANYTIME,
386	.index	= -1,
387};
388
389static void pstore_register_console(void)
390{
 
 
 
 
 
 
 
 
391	register_console(&pstore_console);
392}
 
 
 
 
 
393#else
394static void pstore_register_console(void) {}
 
395#endif
396
397static int pstore_write_compat(enum pstore_type_id type,
398			       enum kmsg_dump_reason reason,
399			       u64 *id, unsigned int part, int count,
400			       bool compressed, size_t size,
401			       struct pstore_info *psi)
402{
403	return psi->write_buf(type, reason, id, part, psinfo->buf, compressed,
404			     size, psi);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
405}
406
407/*
408 * platform specific persistent storage driver registers with
409 * us here. If pstore is already mounted, call the platform
410 * read function right away to populate the file system. If not
411 * then the pstore mount code will call us later to fill out
412 * the file system.
413 *
414 * Register with kmsg_dump to save last part of console log on panic.
415 */
416int pstore_register(struct pstore_info *psi)
417{
418	struct module *owner = psi->owner;
419
420	if (backend && strcmp(backend, psi->name))
421		return -EPERM;
 
 
 
422
423	spin_lock(&pstore_lock);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
424	if (psinfo) {
425		spin_unlock(&pstore_lock);
 
 
 
426		return -EBUSY;
427	}
428
429	if (!psi->write)
430		psi->write = pstore_write_compat;
431	psinfo = psi;
432	mutex_init(&psinfo->read_mutex);
433	spin_unlock(&pstore_lock);
434
435	if (owner && !try_module_get(owner)) {
436		psinfo = NULL;
437		return -EINVAL;
 
 
 
 
 
438	}
 
 
 
 
 
 
439
440	allocate_buf_for_compression();
 
441
442	if (pstore_is_mounted())
443		pstore_get_records(0);
 
 
 
444
445	kmsg_dump_register(&pstore_dumper);
446
447	if ((psi->flags & PSTORE_FLAGS_FRAGILE) == 0) {
448		pstore_register_console();
449		pstore_register_ftrace();
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
450	}
451
452	if (pstore_update_ms >= 0) {
453		pstore_timer.expires = jiffies +
454			msecs_to_jiffies(pstore_update_ms);
455		add_timer(&pstore_timer);
456	}
457
458	pr_info("pstore: Registered %s as persistent store backend\n",
459		psi->name);
 
 
 
460
461	return 0;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
462}
463EXPORT_SYMBOL_GPL(pstore_register);
464
465/*
466 * Read all the records from the persistent store. Create
467 * files in our filesystem.  Don't warn about -EEXIST errors
468 * when we are re-scanning the backing store looking to add new
469 * error records.
470 */
471void pstore_get_records(int quiet)
 
472{
473	struct pstore_info *psi = psinfo;
474	char			*buf = NULL;
475	ssize_t			size;
476	u64			id;
477	int			count;
478	enum pstore_type_id	type;
479	struct timespec		time;
480	int			failed = 0, rc;
481	bool			compressed;
482	int			unzipped_len = -1;
483
484	if (!psi)
485		return;
486
 
 
 
 
 
 
487	mutex_lock(&psi->read_mutex);
488	if (psi->open && psi->open(psi))
489		goto out;
490
491	while ((size = psi->read(&id, &type, &count, &time, &buf, &compressed,
492				psi)) > 0) {
493		if (compressed && (type == PSTORE_TYPE_DMESG)) {
494			if (big_oops_buf)
495				unzipped_len = pstore_decompress(buf,
496							big_oops_buf, size,
497							big_oops_buf_sz);
498
499			if (unzipped_len > 0) {
500				kfree(buf);
501				buf = big_oops_buf;
502				size = unzipped_len;
503				compressed = false;
504			} else {
505				pr_err("pstore: decompression failed;"
506					"returned %d\n", unzipped_len);
507				compressed = true;
508			}
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
509		}
510		rc = pstore_mkfile(type, psi->name, id, count, buf,
511				  compressed, (size_t)size, time, psi);
512		if (unzipped_len < 0) {
513			/* Free buffer other than big oops */
514			kfree(buf);
515			buf = NULL;
516		} else
517			unzipped_len = -1;
518		if (rc && (rc != -EEXIST || !quiet))
519			failed++;
520	}
521	if (psi->close)
522		psi->close(psi);
523out:
524	mutex_unlock(&psi->read_mutex);
525
 
 
 
 
 
 
526	if (failed)
527		printk(KERN_WARNING "pstore: failed to load %d record(s) from '%s'\n",
528		       failed, psi->name);
 
 
 
529}
530
531static void pstore_dowork(struct work_struct *work)
532{
533	pstore_get_records(1);
534}
535
536static void pstore_timefunc(unsigned long dummy)
537{
538	if (pstore_new_entry) {
539		pstore_new_entry = 0;
540		schedule_work(&pstore_work);
541	}
542
543	mod_timer(&pstore_timer, jiffies + msecs_to_jiffies(pstore_update_ms));
544}
545
546module_param(backend, charp, 0444);
547MODULE_PARM_DESC(backend, "Pstore backend to use");
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
v6.8
  1// SPDX-License-Identifier: GPL-2.0-only
  2/*
  3 * Persistent Storage - platform driver interface parts.
  4 *
  5 * Copyright (C) 2007-2008 Google, Inc.
  6 * Copyright (C) 2010 Intel Corporation <tony.luck@intel.com>
 
 
 
 
 
 
 
 
 
 
 
 
 
  7 */
  8
  9#define pr_fmt(fmt) "pstore: " fmt
 10
 11#include <linux/atomic.h>
 12#include <linux/types.h>
 13#include <linux/errno.h>
 14#include <linux/init.h>
 15#include <linux/kmsg_dump.h>
 16#include <linux/console.h>
 17#include <linux/mm.h>
 18#include <linux/module.h>
 19#include <linux/pstore.h>
 
 20#include <linux/string.h>
 21#include <linux/timer.h>
 22#include <linux/slab.h>
 23#include <linux/uaccess.h>
 
 24#include <linux/jiffies.h>
 25#include <linux/vmalloc.h>
 26#include <linux/workqueue.h>
 27#include <linux/zlib.h>
 28
 29#include "internal.h"
 30
 31/*
 32 * We defer making "oops" entries appear in pstore - see
 33 * whether the system is actually still running well enough
 34 * to let someone see the entry
 35 */
 36static int pstore_update_ms = -1;
 37module_param_named(update_ms, pstore_update_ms, int, 0600);
 38MODULE_PARM_DESC(update_ms, "milliseconds before pstore updates its content "
 39		 "(default is -1, which means runtime updates are disabled; "
 40		 "enabling this option may not be safe; it may lead to further "
 41		 "corruption on Oopses)");
 42
 43/* Names should be in the same order as the enum pstore_type_id */
 44static const char * const pstore_type_names[] = {
 45	"dmesg",
 46	"mce",
 47	"console",
 48	"ftrace",
 49	"rtas",
 50	"powerpc-ofw",
 51	"powerpc-common",
 52	"pmsg",
 53	"powerpc-opal",
 54};
 55
 56static int pstore_new_entry;
 57
 58static void pstore_timefunc(struct timer_list *);
 59static DEFINE_TIMER(pstore_timer, pstore_timefunc);
 60
 61static void pstore_dowork(struct work_struct *);
 62static DECLARE_WORK(pstore_work, pstore_dowork);
 63
 64/*
 65 * psinfo_lock protects "psinfo" during calls to
 66 * pstore_register(), pstore_unregister(), and
 67 * the filesystem mount/unmount routines.
 68 */
 69static DEFINE_MUTEX(psinfo_lock);
 70struct pstore_info *psinfo;
 71
 72static char *backend;
 73module_param(backend, charp, 0444);
 74MODULE_PARM_DESC(backend, "specific backend to use");
 75
 76/*
 77 * pstore no longer implements compression via the crypto API, and only
 78 * supports zlib deflate compression implemented using the zlib library
 79 * interface. This removes additional complexity which is hard to justify for a
 80 * diagnostic facility that has to operate in conditions where the system may
 81 * have become unstable. Zlib deflate is comparatively small in terms of code
 82 * size, and compresses ASCII text comparatively well. In terms of compression
 83 * speed, deflate is not the best performer but for recording the log output on
 84 * a kernel panic, this is not considered critical.
 85 *
 86 * The only remaining arguments supported by the compress= module parameter are
 87 * 'deflate' and 'none'. To retain compatibility with existing installations,
 88 * all other values are logged and replaced with 'deflate'.
 89 */
 90static char *compress = "deflate";
 91module_param(compress, charp, 0444);
 92MODULE_PARM_DESC(compress, "compression to use");
 93
 94/* How much of the kernel log to snapshot */
 95unsigned long kmsg_bytes = CONFIG_PSTORE_DEFAULT_KMSG_BYTES;
 96module_param(kmsg_bytes, ulong, 0444);
 97MODULE_PARM_DESC(kmsg_bytes, "amount of kernel log to snapshot (in bytes)");
 98
 99static void *compress_workspace;
100
101/*
102 * Compression is only used for dmesg output, which consists of low-entropy
103 * ASCII text, and so we can assume worst-case 60%.
104 */
105#define DMESG_COMP_PERCENT	60
106
107static char *big_oops_buf;
108static size_t max_compressed_size;
109
110void pstore_set_kmsg_bytes(int bytes)
111{
112	kmsg_bytes = bytes;
113}
114
115/* Tag each group of saved records with a sequence number */
116static int	oopscount;
117
118const char *pstore_type_to_name(enum pstore_type_id type)
119{
120	BUILD_BUG_ON(ARRAY_SIZE(pstore_type_names) != PSTORE_TYPE_MAX);
121
122	if (WARN_ON_ONCE(type >= PSTORE_TYPE_MAX))
123		return "unknown";
124
125	return pstore_type_names[type];
126}
127EXPORT_SYMBOL_GPL(pstore_type_to_name);
128
129enum pstore_type_id pstore_name_to_type(const char *name)
130{
131	int i;
132
133	for (i = 0; i < PSTORE_TYPE_MAX; i++) {
134		if (!strcmp(pstore_type_names[i], name))
135			return i;
136	}
137
138	return PSTORE_TYPE_MAX;
139}
140EXPORT_SYMBOL_GPL(pstore_name_to_type);
141
142static void pstore_timer_kick(void)
143{
144	if (pstore_update_ms < 0)
145		return;
146
147	mod_timer(&pstore_timer, jiffies + msecs_to_jiffies(pstore_update_ms));
148}
149
150static bool pstore_cannot_block_path(enum kmsg_dump_reason reason)
151{
152	/*
153	 * In case of NMI path, pstore shouldn't be blocked
154	 * regardless of reason.
155	 */
156	if (in_nmi())
157		return true;
158
159	switch (reason) {
160	/* In panic case, other cpus are stopped by smp_send_stop(). */
161	case KMSG_DUMP_PANIC:
162	/*
163	 * Emergency restart shouldn't be blocked by spinning on
164	 * pstore_info::buf_lock.
165	 */
166	case KMSG_DUMP_EMERG:
167		return true;
168	default:
169		return false;
170	}
171}
 
172
173static int pstore_compress(const void *in, void *out,
174			   unsigned int inlen, unsigned int outlen)
175{
176	struct z_stream_s zstream = {
177		.next_in	= in,
178		.avail_in	= inlen,
179		.next_out	= out,
180		.avail_out	= outlen,
181		.workspace	= compress_workspace,
182	};
183	int ret;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
184
185	if (!IS_ENABLED(CONFIG_PSTORE_COMPRESS))
186		return -EINVAL;
187
188	ret = zlib_deflateInit2(&zstream, Z_DEFAULT_COMPRESSION, Z_DEFLATED,
189				-MAX_WBITS, DEF_MEM_LEVEL, Z_DEFAULT_STRATEGY);
190	if (ret != Z_OK)
191		return -EINVAL;
192
193	ret = zlib_deflate(&zstream, Z_FINISH);
194	if (ret != Z_STREAM_END)
195		return -EINVAL;
 
196
197	ret = zlib_deflateEnd(&zstream);
198	if (ret != Z_OK)
199		pr_warn_once("zlib_deflateEnd() failed: %d\n", ret);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
200
201	return zstream.total_out;
 
 
202}
203
204static void allocate_buf_for_compression(void)
205{
206	size_t compressed_size;
207	char *buf;
208
209	/* Skip if not built-in or compression disabled. */
210	if (!IS_ENABLED(CONFIG_PSTORE_COMPRESS) || !compress ||
211	    !strcmp(compress, "none")) {
212		compress = NULL;
213		return;
 
 
 
 
 
 
 
 
 
 
 
 
 
214	}
215
216	if (strcmp(compress, "deflate")) {
217		pr_err("Unsupported compression '%s', falling back to deflate\n",
218		       compress);
219		compress = "deflate";
220	}
221
222	/*
223	 * The compression buffer only needs to be as large as the maximum
224	 * uncompressed record size, since any record that would be expanded by
225	 * compression is just stored uncompressed.
226	 */
227	compressed_size = (psinfo->bufsize * 100) / DMESG_COMP_PERCENT;
228	buf = kvzalloc(compressed_size, GFP_KERNEL);
229	if (!buf) {
230		pr_err("Failed %zu byte compression buffer allocation for: %s\n",
231		       psinfo->bufsize, compress);
232		return;
233	}
234
235	compress_workspace =
236		vmalloc(zlib_deflate_workspacesize(MAX_WBITS, DEF_MEM_LEVEL));
237	if (!compress_workspace) {
238		pr_err("Failed to allocate zlib deflate workspace\n");
239		kvfree(buf);
240		return;
241	}
242
243	/* A non-NULL big_oops_buf indicates compression is available. */
244	big_oops_buf = buf;
245	max_compressed_size = compressed_size;
246
247	pr_info("Using crash dump compression: %s\n", compress);
248}
249
250static void free_buf_for_compression(void)
 
 
 
 
 
 
 
251{
252	if (IS_ENABLED(CONFIG_PSTORE_COMPRESS) && compress_workspace) {
253		vfree(compress_workspace);
254		compress_workspace = NULL;
255	}
256
257	kvfree(big_oops_buf);
258	big_oops_buf = NULL;
259	max_compressed_size = 0;
260}
261
262void pstore_record_init(struct pstore_record *record,
263			struct pstore_info *psinfo)
264{
265	memset(record, 0, sizeof(*record));
266
267	record->psi = psinfo;
 
 
 
 
 
 
 
268
269	/* Report zeroed timestamp if called before timekeeping has resumed. */
270	record->time = ns_to_timespec64(ktime_get_real_fast_ns());
271}
272
273/*
274 * callback from kmsg_dump. Save as much as we can (up to kmsg_bytes) from the
275 * end of the buffer.
 
276 */
277static void pstore_dump(struct kmsg_dumper *dumper,
278			enum kmsg_dump_reason reason)
279{
280	struct kmsg_dump_iter iter;
281	unsigned long	total = 0;
282	const char	*why;
 
283	unsigned int	part = 1;
284	unsigned long	flags = 0;
285	int		saved_ret = 0;
286	int		ret;
287
288	why = kmsg_dump_reason_str(reason);
289
290	if (pstore_cannot_block_path(reason)) {
291		if (!spin_trylock_irqsave(&psinfo->buf_lock, flags)) {
292			pr_err("dump skipped in %s path because of concurrent dump\n",
293					in_nmi() ? "NMI" : why);
294			return;
295		}
296	} else {
297		spin_lock_irqsave(&psinfo->buf_lock, flags);
298	}
299
300	kmsg_dump_rewind(&iter);
301
302	oopscount++;
303	while (total < kmsg_bytes) {
304		char *dst;
305		size_t dst_size;
306		int header_size;
307		int zipped_len = -1;
308		size_t dump_size;
309		struct pstore_record record;
 
310
311		pstore_record_init(&record, psinfo);
312		record.type = PSTORE_TYPE_DMESG;
313		record.count = oopscount;
314		record.reason = reason;
315		record.part = part;
316		record.buf = psinfo->buf;
317
318		dst = big_oops_buf ?: psinfo->buf;
319		dst_size = max_compressed_size ?: psinfo->bufsize;
320
321		/* Write dump header. */
322		header_size = snprintf(dst, dst_size, "%s#%d Part%u\n", why,
323				 oopscount, part);
324		dst_size -= header_size;
325
326		/* Write dump contents. */
327		if (!kmsg_dump_get_buffer(&iter, true, dst + header_size,
328					  dst_size, &dump_size))
329			break;
330
331		if (big_oops_buf) {
332			zipped_len = pstore_compress(dst, psinfo->buf,
333						header_size + dump_size,
334						psinfo->bufsize);
335
336			if (zipped_len > 0) {
337				record.compressed = true;
338				record.size = zipped_len;
339			} else {
340				/*
341				 * Compression failed, so the buffer is most
342				 * likely filled with binary data that does not
343				 * compress as well as ASCII text. Copy as much
344				 * of the uncompressed data as possible into
345				 * the pstore record, and discard the rest.
346				 */
347				record.size = psinfo->bufsize;
348				memcpy(psinfo->buf, dst, psinfo->bufsize);
349			}
350		} else {
351			record.size = header_size + dump_size;
 
 
 
 
 
 
 
 
 
 
 
352		}
353
354		ret = psinfo->write(&record);
355		if (ret == 0 && reason == KMSG_DUMP_OOPS) {
 
356			pstore_new_entry = 1;
357			pstore_timer_kick();
358		} else {
359			/* Preserve only the first non-zero returned value. */
360			if (!saved_ret)
361				saved_ret = ret;
362		}
363
364		total += record.size;
365		part++;
366	}
367	spin_unlock_irqrestore(&psinfo->buf_lock, flags);
368
369	if (saved_ret) {
370		pr_err_once("backend (%s) writing error (%d)\n", psinfo->name,
371			    saved_ret);
372	}
373}
374
375static struct kmsg_dumper pstore_dumper = {
376	.dump = pstore_dump,
377};
378
379/*
380 * Register with kmsg_dump to save last part of console log on panic.
381 */
382static void pstore_register_kmsg(void)
383{
384	kmsg_dump_register(&pstore_dumper);
385}
386
387static void pstore_unregister_kmsg(void)
388{
389	kmsg_dump_unregister(&pstore_dumper);
390}
391
392#ifdef CONFIG_PSTORE_CONSOLE
393static void pstore_console_write(struct console *con, const char *s, unsigned c)
394{
395	struct pstore_record record;
396
397	if (!c)
398		return;
399
400	pstore_record_init(&record, psinfo);
401	record.type = PSTORE_TYPE_CONSOLE;
402
403	record.buf = (char *)s;
404	record.size = c;
405	psinfo->write(&record);
 
 
 
 
 
 
 
 
 
 
406}
407
408static struct console pstore_console = {
 
409	.write	= pstore_console_write,
 
410	.index	= -1,
411};
412
413static void pstore_register_console(void)
414{
415	/* Show which backend is going to get console writes. */
416	strscpy(pstore_console.name, psinfo->name,
417		sizeof(pstore_console.name));
418	/*
419	 * Always initialize flags here since prior unregister_console()
420	 * calls may have changed settings (specifically CON_ENABLED).
421	 */
422	pstore_console.flags = CON_PRINTBUFFER | CON_ENABLED | CON_ANYTIME;
423	register_console(&pstore_console);
424}
425
426static void pstore_unregister_console(void)
427{
428	unregister_console(&pstore_console);
429}
430#else
431static void pstore_register_console(void) {}
432static void pstore_unregister_console(void) {}
433#endif
434
435static int pstore_write_user_compat(struct pstore_record *record,
436				    const char __user *buf)
 
 
 
437{
438	int ret = 0;
439
440	if (record->buf)
441		return -EINVAL;
442
443	record->buf = vmemdup_user(buf, record->size);
444	if (IS_ERR(record->buf)) {
445		ret = PTR_ERR(record->buf);
446		goto out;
447	}
448
449	ret = record->psi->write(record);
450
451	kvfree(record->buf);
452out:
453	record->buf = NULL;
454
455	return unlikely(ret < 0) ? ret : record->size;
456}
457
458/*
459 * platform specific persistent storage driver registers with
460 * us here. If pstore is already mounted, call the platform
461 * read function right away to populate the file system. If not
462 * then the pstore mount code will call us later to fill out
463 * the file system.
 
 
464 */
465int pstore_register(struct pstore_info *psi)
466{
467	char *new_backend;
468
469	if (backend && strcmp(backend, psi->name)) {
470		pr_warn("backend '%s' already in use: ignoring '%s'\n",
471			backend, psi->name);
472		return -EBUSY;
473	}
474
475	/* Sanity check flags. */
476	if (!psi->flags) {
477		pr_warn("backend '%s' must support at least one frontend\n",
478			psi->name);
479		return -EINVAL;
480	}
481
482	/* Check for required functions. */
483	if (!psi->read || !psi->write) {
484		pr_warn("backend '%s' must implement read() and write()\n",
485			psi->name);
486		return -EINVAL;
487	}
488
489	new_backend = kstrdup(psi->name, GFP_KERNEL);
490	if (!new_backend)
491		return -ENOMEM;
492
493	mutex_lock(&psinfo_lock);
494	if (psinfo) {
495		pr_warn("backend '%s' already loaded: ignoring '%s'\n",
496			psinfo->name, psi->name);
497		mutex_unlock(&psinfo_lock);
498		kfree(new_backend);
499		return -EBUSY;
500	}
501
502	if (!psi->write_user)
503		psi->write_user = pstore_write_user_compat;
504	psinfo = psi;
505	mutex_init(&psinfo->read_mutex);
506	spin_lock_init(&psinfo->buf_lock);
507
508	if (psi->flags & PSTORE_FLAGS_DMESG)
509		allocate_buf_for_compression();
510
511	pstore_get_records(0);
512
513	if (psi->flags & PSTORE_FLAGS_DMESG) {
514		pstore_dumper.max_reason = psinfo->max_reason;
515		pstore_register_kmsg();
516	}
517	if (psi->flags & PSTORE_FLAGS_CONSOLE)
518		pstore_register_console();
519	if (psi->flags & PSTORE_FLAGS_FTRACE)
520		pstore_register_ftrace();
521	if (psi->flags & PSTORE_FLAGS_PMSG)
522		pstore_register_pmsg();
523
524	/* Start watching for new records, if desired. */
525	pstore_timer_kick();
526
527	/*
528	 * Update the module parameter backend, so it is visible
529	 * through /sys/module/pstore/parameters/backend
530	 */
531	backend = new_backend;
532
533	pr_info("Registered %s as persistent store backend\n", psi->name);
534
535	mutex_unlock(&psinfo_lock);
536	return 0;
537}
538EXPORT_SYMBOL_GPL(pstore_register);
539
540void pstore_unregister(struct pstore_info *psi)
541{
542	/* It's okay to unregister nothing. */
543	if (!psi)
544		return;
545
546	mutex_lock(&psinfo_lock);
547
548	/* Only one backend can be registered at a time. */
549	if (WARN_ON(psi != psinfo)) {
550		mutex_unlock(&psinfo_lock);
551		return;
552	}
553
554	/* Unregister all callbacks. */
555	if (psi->flags & PSTORE_FLAGS_PMSG)
556		pstore_unregister_pmsg();
557	if (psi->flags & PSTORE_FLAGS_FTRACE)
558		pstore_unregister_ftrace();
559	if (psi->flags & PSTORE_FLAGS_CONSOLE)
560		pstore_unregister_console();
561	if (psi->flags & PSTORE_FLAGS_DMESG)
562		pstore_unregister_kmsg();
563
564	/* Stop timer and make sure all work has finished. */
565	del_timer_sync(&pstore_timer);
566	flush_work(&pstore_work);
567
568	/* Remove all backend records from filesystem tree. */
569	pstore_put_backend_records(psi);
570
571	free_buf_for_compression();
572
573	psinfo = NULL;
574	kfree(backend);
575	backend = NULL;
576
577	pr_info("Unregistered %s as persistent store backend\n", psi->name);
578	mutex_unlock(&psinfo_lock);
579}
580EXPORT_SYMBOL_GPL(pstore_unregister);
581
582static void decompress_record(struct pstore_record *record,
583			      struct z_stream_s *zstream)
584{
585	int ret;
586	int unzipped_len;
587	char *unzipped, *workspace;
588	size_t max_uncompressed_size;
589
590	if (!IS_ENABLED(CONFIG_PSTORE_COMPRESS) || !record->compressed)
591		return;
592
593	/* Only PSTORE_TYPE_DMESG support compression. */
594	if (record->type != PSTORE_TYPE_DMESG) {
595		pr_warn("ignored compressed record type %d\n", record->type);
596		return;
597	}
598
599	/* Missing compression buffer means compression was not initialized. */
600	if (!zstream->workspace) {
601		pr_warn("no decompression method initialized!\n");
602		return;
603	}
604
605	ret = zlib_inflateReset(zstream);
606	if (ret != Z_OK) {
607		pr_err("zlib_inflateReset() failed, ret = %d!\n", ret);
608		return;
609	}
610
611	/* Allocate enough space to hold max decompression and ECC. */
612	max_uncompressed_size = 3 * psinfo->bufsize;
613	workspace = kvzalloc(max_uncompressed_size + record->ecc_notice_size,
614			     GFP_KERNEL);
615	if (!workspace)
616		return;
617
618	zstream->next_in	= record->buf;
619	zstream->avail_in	= record->size;
620	zstream->next_out	= workspace;
621	zstream->avail_out	= max_uncompressed_size;
622
623	ret = zlib_inflate(zstream, Z_FINISH);
624	if (ret != Z_STREAM_END) {
625		pr_err_ratelimited("zlib_inflate() failed, ret = %d!\n", ret);
626		kvfree(workspace);
627		return;
628	}
629
630	unzipped_len = zstream->total_out;
631
632	/* Append ECC notice to decompressed buffer. */
633	memcpy(workspace + unzipped_len, record->buf + record->size,
634	       record->ecc_notice_size);
635
636	/* Copy decompressed contents into an minimum-sized allocation. */
637	unzipped = kvmemdup(workspace, unzipped_len + record->ecc_notice_size,
638			    GFP_KERNEL);
639	kvfree(workspace);
640	if (!unzipped)
641		return;
642
643	/* Swap out compressed contents with decompressed contents. */
644	kvfree(record->buf);
645	record->buf = unzipped;
646	record->size = unzipped_len;
647	record->compressed = false;
648}
 
649
650/*
651 * Read all the records from one persistent store backend. Create
652 * files in our filesystem.  Don't warn about -EEXIST errors
653 * when we are re-scanning the backing store looking to add new
654 * error records.
655 */
656void pstore_get_backend_records(struct pstore_info *psi,
657				struct dentry *root, int quiet)
658{
659	int failed = 0;
660	unsigned int stop_loop = 65536;
661	struct z_stream_s zstream = {};
 
 
 
 
 
 
 
662
663	if (!psi || !root)
664		return;
665
666	if (IS_ENABLED(CONFIG_PSTORE_COMPRESS) && compress) {
667		zstream.workspace = kvmalloc(zlib_inflate_workspacesize(),
668					     GFP_KERNEL);
669		zlib_inflateInit2(&zstream, -DEF_WBITS);
670	}
671
672	mutex_lock(&psi->read_mutex);
673	if (psi->open && psi->open(psi))
674		goto out;
675
676	/*
677	 * Backend callback read() allocates record.buf. decompress_record()
678	 * may reallocate record.buf. On success, pstore_mkfile() will keep
679	 * the record.buf, so free it only on failure.
680	 */
681	for (; stop_loop; stop_loop--) {
682		struct pstore_record *record;
683		int rc;
684
685		record = kzalloc(sizeof(*record), GFP_KERNEL);
686		if (!record) {
687			pr_err("out of memory creating record\n");
688			break;
689		}
690		pstore_record_init(record, psi);
691
692		record->size = psi->read(record);
693
694		/* No more records left in backend? */
695		if (record->size <= 0) {
696			kfree(record);
697			break;
698		}
699
700		decompress_record(record, &zstream);
701		rc = pstore_mkfile(root, record);
702		if (rc) {
703			/* pstore_mkfile() did not take record, so free it. */
704			kvfree(record->buf);
705			kfree(record->priv);
706			kfree(record);
707			if (rc != -EEXIST || !quiet)
708				failed++;
709		}
 
 
 
 
 
 
 
 
 
 
710	}
711	if (psi->close)
712		psi->close(psi);
713out:
714	mutex_unlock(&psi->read_mutex);
715
716	if (IS_ENABLED(CONFIG_PSTORE_COMPRESS) && compress) {
717		if (zlib_inflateEnd(&zstream) != Z_OK)
718			pr_warn("zlib_inflateEnd() failed\n");
719		kvfree(zstream.workspace);
720	}
721
722	if (failed)
723		pr_warn("failed to create %d record(s) from '%s'\n",
724			failed, psi->name);
725	if (!stop_loop)
726		pr_err("looping? Too many records seen from '%s'\n",
727			psi->name);
728}
729
730static void pstore_dowork(struct work_struct *work)
731{
732	pstore_get_records(1);
733}
734
735static void pstore_timefunc(struct timer_list *unused)
736{
737	if (pstore_new_entry) {
738		pstore_new_entry = 0;
739		schedule_work(&pstore_work);
740	}
741
742	pstore_timer_kick();
743}
744
745static int __init pstore_init(void)
746{
747	int ret;
748
749	ret = pstore_init_fs();
750	if (ret)
751		free_buf_for_compression();
752
753	return ret;
754}
755late_initcall(pstore_init);
756
757static void __exit pstore_exit(void)
758{
759	pstore_exit_fs();
760}
761module_exit(pstore_exit)
762
763MODULE_AUTHOR("Tony Luck <tony.luck@intel.com>");
764MODULE_LICENSE("GPL");