Merge "soc: qcom: add microdump collector"

       obj-y += subsystem_notif.o

       obj-y += subsystem_restart.o

       obj-y += ramdump.o

       obj-y += microdump_collector.o

endif

obj-$(CONFIG_MSM_JTAGV8) += jtagv8.o jtagv8-etm.o

obj-$(CONFIG_QCOM_COMMAND_DB) += cmd-db.o

/* Copyright (c) 2018, The Linux Foundation. All rights reserved.

 *

 * This program is free software; you can redistribute it and/or modify

 * it under the terms of the GNU General Public License version 2 and

 * only version 2 as published by the Free Software Foundation.

 *

 * This program is distributed in the hope that it will be useful,

 * but WITHOUT ANY WARRANTY; without even the implied warranty of

 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the

 * GNU General Public License for more details.

 */

#include <linux/init.h>

#include <linux/module.h>

#include <linux/slab.h>

#include <soc/qcom/subsystem_notif.h>

#include <soc/qcom/ramdump.h>

#include <soc/qcom/smem.h>

/*

 * This program collects the data from SMEM regions whenever the modem crashes

 * and stores it in /dev/ramdump_microdump_modem so as to expose it to

 * user space.

 */

struct microdump_data {

	struct ramdump_device *microdump_dev;

	void *microdump_modem_notify_handler;

	struct notifier_block microdump_modem_ssr_nb;

};

static struct microdump_data *drv;

static int microdump_modem_notifier_nb(struct notifier_block *nb,

		unsigned long code, void *data)

{

	int ret = 0;

	unsigned int size_reason = 0, size_data = 0;

	char *crash_reason = NULL;

	char *crash_data = NULL;

	unsigned int smem_id = 611;

	struct ramdump_segment segment[2];

	if (code == SUBSYS_RAMDUMP_NOTIFICATION) {

		memset(segment, 0, sizeof(segment));

		crash_reason = smem_get_entry(SMEM_SSR_REASON_MSS0, &size_reason

				, 0, SMEM_ANY_HOST_FLAG);

		if (IS_ERR_OR_NULL(crash_reason)) {

			pr_err("%s: Error in getting SMEM_reason pointer\n",

				__func__);

			return -ENODEV;

		}

		segment[0].v_address = crash_reason;

		segment[0].size = size_reason;

		crash_data = smem_get_entry(smem_id, &size_data, SMEM_MODEM, 0);

		if (IS_ERR_OR_NULL(crash_data)) {

			pr_err("%s: Error in getting SMEM_data pointer\n",

				__func__);

			return -ENODEV;

		}

		segment[1].v_address = crash_data;

		segment[1].size = size_data;

		ret = do_ramdump(drv->microdump_dev, segment, 2);

		if (ret)

			pr_err("%s: do_ramdump() failed\n", __func__);

	}

	return ret;

}

static int microdump_modem_ssr_register_notifier(struct microdump_data *drv)

{

	int ret = 0;

	drv->microdump_modem_ssr_nb.notifier_call = microdump_modem_notifier_nb;

	drv->microdump_modem_notify_handler =

		subsys_notif_register_notifier("modem",

			&drv->microdump_modem_ssr_nb);

	if (IS_ERR(drv->microdump_modem_notify_handler)) {

		pr_err("Modem register notifier failed: %ld\n",

			PTR_ERR(drv->microdump_modem_notify_handler));

		ret = -EINVAL;

	}

	return ret;

}

static void microdump_modem_ssr_unregister_notifier(struct microdump_data *drv)

{

	subsys_notif_unregister_notifier(drv->microdump_modem_notify_handler,

					&drv->microdump_modem_ssr_nb);

	drv->microdump_modem_notify_handler = NULL;

}

/*

 * microdump_init() - Registers kernel module for microdump collector

 *

 * Creates device file /dev/ramdump_microdump_modem and registers handler for

 * modem SSR events.

 *

 * Returns 0 on success and negative error code in case of errors

 */

static int __init microdump_init(void)

{

	int ret = -ENOMEM;

	drv = kzalloc(sizeof(struct microdump_data), GFP_KERNEL);

	if (!drv)

		goto out;

	drv->microdump_dev = create_ramdump_device("microdump_modem", NULL);

	if (!drv->microdump_dev) {

		pr_err("%s: Unable to create a microdump_modem ramdump device\n"

			, __func__);

		ret = -ENODEV;

		goto out_kfree;

	}

	ret = microdump_modem_ssr_register_notifier(drv);

	if (ret) {

		destroy_ramdump_device(drv->microdump_dev);

		goto out_kfree;

	}

	return ret;

out_kfree:

	pr_err("%s: Failed to register microdump collector\n", __func__);

	kfree(drv);

	drv = NULL;

out:

	return ret;

}

static void __exit microdump_exit(void)

{

	if (!drv)

		return;

	if (!IS_ERR(drv->microdump_modem_notify_handler))

		microdump_modem_ssr_unregister_notifier(drv);

	if (drv->microdump_dev)

		destroy_ramdump_device(drv->microdump_dev);

	kfree(drv);

}

module_init(microdump_init);

module_exit(microdump_exit);

MODULE_DESCRIPTION("Microdump Collector");

MODULE_LICENSE("GPL v2");