1 // SPDX-License-Identifier: GPL-2.0-or-later
2
3 #include <linux/kconfig.h>
4 #include <linux/types.h>
5 #include <linux/fault-inject.h>
6 #include <linux/module.h>
7 #include <ufs/ufshcd.h>
8 #include "ufs-fault-injection.h"
9
10 static int ufs_fault_get(char *buffer, const struct kernel_param *kp);
11 static int ufs_fault_set(const char *val, const struct kernel_param *kp);
12
13 static const struct kernel_param_ops ufs_fault_ops = {
14 .get = ufs_fault_get,
15 .set = ufs_fault_set,
16 };
17
18 enum { FAULT_INJ_STR_SIZE = 80 };
19
20 /*
21 * For more details about fault injection, please refer to
22 * Documentation/fault-injection/fault-injection.rst.
23 */
24 static char g_trigger_eh_str[FAULT_INJ_STR_SIZE];
25 module_param_cb(trigger_eh, &ufs_fault_ops, g_trigger_eh_str, 0644);
26 MODULE_PARM_DESC(trigger_eh,
27 "Fault injection. trigger_eh=<interval>,<probability>,<space>,<times>");
28 static DECLARE_FAULT_ATTR(ufs_trigger_eh_attr);
29
30 static char g_timeout_str[FAULT_INJ_STR_SIZE];
31 module_param_cb(timeout, &ufs_fault_ops, g_timeout_str, 0644);
32 MODULE_PARM_DESC(timeout,
33 "Fault injection. timeout=<interval>,<probability>,<space>,<times>");
34 static DECLARE_FAULT_ATTR(ufs_timeout_attr);
35
ufs_fault_get(char * buffer,const struct kernel_param * kp)36 static int ufs_fault_get(char *buffer, const struct kernel_param *kp)
37 {
38 const char *fault_str = kp->arg;
39
40 return sysfs_emit(buffer, "%s\n", fault_str);
41 }
42
ufs_fault_set(const char * val,const struct kernel_param * kp)43 static int ufs_fault_set(const char *val, const struct kernel_param *kp)
44 {
45 struct fault_attr *attr = NULL;
46
47 if (kp->arg == g_trigger_eh_str)
48 attr = &ufs_trigger_eh_attr;
49 else if (kp->arg == g_timeout_str)
50 attr = &ufs_timeout_attr;
51
52 if (WARN_ON_ONCE(!attr))
53 return -EINVAL;
54
55 if (!setup_fault_attr(attr, (char *)val))
56 return -EINVAL;
57
58 strscpy(kp->arg, val, FAULT_INJ_STR_SIZE);
59
60 return 0;
61 }
62
ufs_fault_inject_hba_init(struct ufs_hba * hba)63 void ufs_fault_inject_hba_init(struct ufs_hba *hba)
64 {
65 hba->trigger_eh_attr = ufs_trigger_eh_attr;
66 hba->timeout_attr = ufs_timeout_attr;
67 #ifdef CONFIG_FAULT_INJECTION_DEBUG_FS
68 fault_create_debugfs_attr("trigger_eh_inject", hba->debugfs_root, &hba->trigger_eh_attr);
69 fault_create_debugfs_attr("timeout_inject", hba->debugfs_root, &hba->timeout_attr);
70 #endif
71 }
72
ufs_trigger_eh(struct ufs_hba * hba)73 bool ufs_trigger_eh(struct ufs_hba *hba)
74 {
75 return should_fail(&hba->trigger_eh_attr, 1);
76 }
77
ufs_fail_completion(struct ufs_hba * hba)78 bool ufs_fail_completion(struct ufs_hba *hba)
79 {
80 return should_fail(&hba->timeout_attr, 1);
81 }
82