1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
|
// SPDX-License-Identifier: GPL-2.0-only
/*
* Copyright (c) 2018-2020, The Linux Foundation. All rights reserved.
*/
#include <linux/init.h>
#include <linux/module.h>
#include <linux/slab.h>
#include <soc/qcom/subsystem_notif.h>
#include <soc/qcom/ramdump.h>
#include <linux/soc/qcom/smem.h>
#define SMEM_SSR_REASON_MSS0 421
#define SMEM_SSR_DATA_MSS0 611
#define SMEM_MODEM 1
/*
* 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;
size_t size_reason = 0, size_data = 0;
void *crash_reason = NULL;
void *crash_data = NULL;
struct ramdump_segment segment[2];
if (SUBSYS_RAMDUMP_NOTIFICATION != code && SUBSYS_SOC_RESET != code)
return NOTIFY_OK;
memset(segment, 0, sizeof(segment));
crash_reason = qcom_smem_get(QCOM_SMEM_HOST_ANY
, SMEM_SSR_REASON_MSS0, &size_reason);
if (IS_ERR_OR_NULL(crash_reason)) {
pr_info("%s: smem %d not available\n",
__func__, SMEM_SSR_REASON_MSS0);
goto out;
}
segment[0].v_address = (void __iomem *) crash_reason;
segment[0].size = size_reason;
crash_data = qcom_smem_get(SMEM_MODEM
, SMEM_SSR_DATA_MSS0, &size_data);
if (IS_ERR_OR_NULL(crash_data)) {
pr_info("%s: smem %d not available\n",
__func__, SMEM_SSR_DATA_MSS0);
goto out;
}
segment[1].v_address = (void __iomem *) crash_data;
segment[1].size = size_data;
ret = do_ramdump(drv->microdump_dev, segment, 2);
if (ret)
pr_info("%s: do_ramdump() failed\n", __func__);
out:
return NOTIFY_OK;
}
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)
{
microdump_modem_ssr_unregister_notifier(drv);
destroy_ramdump_device(drv->microdump_dev);
kfree(drv);
}
module_init(microdump_init);
module_exit(microdump_exit);
MODULE_DESCRIPTION("Microdump Collector");
MODULE_LICENSE("GPL v2");
|