Loading...
1// SPDX-License-Identifier: GPL-2.0
2/* Copyright (c) 2019 Mellanox Technologies. All rights reserved */
3
4#include <linux/debugfs.h>
5#include <linux/err.h>
6#include <linux/kernel.h>
7#include <linux/slab.h>
8
9#include "netdevsim.h"
10
11static int
12nsim_dev_empty_reporter_dump(struct devlink_health_reporter *reporter,
13 struct devlink_fmsg *fmsg, void *priv_ctx,
14 struct netlink_ext_ack *extack)
15{
16 return 0;
17}
18
19static int
20nsim_dev_empty_reporter_diagnose(struct devlink_health_reporter *reporter,
21 struct devlink_fmsg *fmsg,
22 struct netlink_ext_ack *extack)
23{
24 return 0;
25}
26
27static const
28struct devlink_health_reporter_ops nsim_dev_empty_reporter_ops = {
29 .name = "empty",
30 .dump = nsim_dev_empty_reporter_dump,
31 .diagnose = nsim_dev_empty_reporter_diagnose,
32};
33
34struct nsim_dev_dummy_reporter_ctx {
35 char *break_msg;
36};
37
38static int
39nsim_dev_dummy_reporter_recover(struct devlink_health_reporter *reporter,
40 void *priv_ctx,
41 struct netlink_ext_ack *extack)
42{
43 struct nsim_dev_health *health = devlink_health_reporter_priv(reporter);
44 struct nsim_dev_dummy_reporter_ctx *ctx = priv_ctx;
45
46 if (health->fail_recover) {
47 /* For testing purposes, user set debugfs fail_recover
48 * value to true. Fail right away.
49 */
50 NL_SET_ERR_MSG_MOD(extack, "User setup the recover to fail for testing purposes");
51 return -EINVAL;
52 }
53 if (ctx) {
54 kfree(health->recovered_break_msg);
55 health->recovered_break_msg = kstrdup(ctx->break_msg,
56 GFP_KERNEL);
57 if (!health->recovered_break_msg)
58 return -ENOMEM;
59 }
60 return 0;
61}
62
63static int nsim_dev_dummy_fmsg_put(struct devlink_fmsg *fmsg, u32 binary_len)
64{
65 char *binary;
66 int i;
67
68 devlink_fmsg_bool_pair_put(fmsg, "test_bool", true);
69 devlink_fmsg_u8_pair_put(fmsg, "test_u8", 1);
70 devlink_fmsg_u32_pair_put(fmsg, "test_u32", 3);
71 devlink_fmsg_u64_pair_put(fmsg, "test_u64", 4);
72 devlink_fmsg_string_pair_put(fmsg, "test_string", "somestring");
73
74 binary = kmalloc(binary_len, GFP_KERNEL | __GFP_NOWARN);
75 if (!binary)
76 return -ENOMEM;
77 get_random_bytes(binary, binary_len);
78 devlink_fmsg_binary_pair_put(fmsg, "test_binary", binary, binary_len);
79 kfree(binary);
80
81 devlink_fmsg_pair_nest_start(fmsg, "test_nest");
82 devlink_fmsg_obj_nest_start(fmsg);
83 devlink_fmsg_bool_pair_put(fmsg, "nested_test_bool", false);
84 devlink_fmsg_u8_pair_put(fmsg, "nested_test_u8", false);
85 devlink_fmsg_obj_nest_end(fmsg);
86 devlink_fmsg_pair_nest_end(fmsg);
87 devlink_fmsg_arr_pair_nest_end(fmsg);
88 devlink_fmsg_arr_pair_nest_start(fmsg, "test_u32_array");
89
90 for (i = 0; i < 10; i++)
91 devlink_fmsg_u32_put(fmsg, i);
92 devlink_fmsg_arr_pair_nest_end(fmsg);
93 devlink_fmsg_arr_pair_nest_start(fmsg, "test_array_of_objects");
94
95 for (i = 0; i < 10; i++) {
96 devlink_fmsg_obj_nest_start(fmsg);
97 devlink_fmsg_bool_pair_put(fmsg, "in_array_nested_test_bool",
98 false);
99 devlink_fmsg_u8_pair_put(fmsg, "in_array_nested_test_u8", i);
100 devlink_fmsg_obj_nest_end(fmsg);
101 }
102 devlink_fmsg_arr_pair_nest_end(fmsg);
103
104 return 0;
105}
106
107static int
108nsim_dev_dummy_reporter_dump(struct devlink_health_reporter *reporter,
109 struct devlink_fmsg *fmsg, void *priv_ctx,
110 struct netlink_ext_ack *extack)
111{
112 struct nsim_dev_health *health = devlink_health_reporter_priv(reporter);
113 struct nsim_dev_dummy_reporter_ctx *ctx = priv_ctx;
114
115 if (ctx)
116 devlink_fmsg_string_pair_put(fmsg, "break_message", ctx->break_msg);
117
118 return nsim_dev_dummy_fmsg_put(fmsg, health->binary_len);
119}
120
121static int
122nsim_dev_dummy_reporter_diagnose(struct devlink_health_reporter *reporter,
123 struct devlink_fmsg *fmsg,
124 struct netlink_ext_ack *extack)
125{
126 struct nsim_dev_health *health = devlink_health_reporter_priv(reporter);
127
128 if (health->recovered_break_msg)
129 devlink_fmsg_string_pair_put(fmsg, "recovered_break_message",
130 health->recovered_break_msg);
131
132 return nsim_dev_dummy_fmsg_put(fmsg, health->binary_len);
133}
134
135static const
136struct devlink_health_reporter_ops nsim_dev_dummy_reporter_ops = {
137 .name = "dummy",
138 .recover = nsim_dev_dummy_reporter_recover,
139 .dump = nsim_dev_dummy_reporter_dump,
140 .diagnose = nsim_dev_dummy_reporter_diagnose,
141};
142
143static ssize_t nsim_dev_health_break_write(struct file *file,
144 const char __user *data,
145 size_t count, loff_t *ppos)
146{
147 struct nsim_dev_health *health = file->private_data;
148 struct nsim_dev_dummy_reporter_ctx ctx;
149 char *break_msg;
150 int err;
151
152 break_msg = memdup_user_nul(data, count);
153 if (IS_ERR(break_msg))
154 return PTR_ERR(break_msg);
155
156 if (break_msg[count - 1] == '\n')
157 break_msg[count - 1] = '\0';
158
159 ctx.break_msg = break_msg;
160 err = devlink_health_report(health->dummy_reporter, break_msg, &ctx);
161 if (err)
162 goto out;
163
164out:
165 kfree(break_msg);
166 return err ?: count;
167}
168
169static const struct file_operations nsim_dev_health_break_fops = {
170 .open = simple_open,
171 .write = nsim_dev_health_break_write,
172 .llseek = generic_file_llseek,
173 .owner = THIS_MODULE,
174};
175
176int nsim_dev_health_init(struct nsim_dev *nsim_dev, struct devlink *devlink)
177{
178 struct nsim_dev_health *health = &nsim_dev->health;
179 int err;
180
181 health->empty_reporter =
182 devl_health_reporter_create(devlink,
183 &nsim_dev_empty_reporter_ops,
184 0, health);
185 if (IS_ERR(health->empty_reporter))
186 return PTR_ERR(health->empty_reporter);
187
188 health->dummy_reporter =
189 devl_health_reporter_create(devlink,
190 &nsim_dev_dummy_reporter_ops,
191 0, health);
192 if (IS_ERR(health->dummy_reporter)) {
193 err = PTR_ERR(health->dummy_reporter);
194 goto err_empty_reporter_destroy;
195 }
196
197 health->ddir = debugfs_create_dir("health", nsim_dev->ddir);
198 if (IS_ERR(health->ddir)) {
199 err = PTR_ERR(health->ddir);
200 goto err_dummy_reporter_destroy;
201 }
202
203 health->recovered_break_msg = NULL;
204 debugfs_create_file("break_health", 0200, health->ddir, health,
205 &nsim_dev_health_break_fops);
206 health->binary_len = 16;
207 debugfs_create_u32("binary_len", 0600, health->ddir,
208 &health->binary_len);
209 health->fail_recover = false;
210 debugfs_create_bool("fail_recover", 0600, health->ddir,
211 &health->fail_recover);
212 return 0;
213
214err_dummy_reporter_destroy:
215 devl_health_reporter_destroy(health->dummy_reporter);
216err_empty_reporter_destroy:
217 devl_health_reporter_destroy(health->empty_reporter);
218 return err;
219}
220
221void nsim_dev_health_exit(struct nsim_dev *nsim_dev)
222{
223 struct nsim_dev_health *health = &nsim_dev->health;
224
225 debugfs_remove_recursive(health->ddir);
226 kfree(health->recovered_break_msg);
227 devl_health_reporter_destroy(health->dummy_reporter);
228 devl_health_reporter_destroy(health->empty_reporter);
229}
1// SPDX-License-Identifier: GPL-2.0
2/* Copyright (c) 2019 Mellanox Technologies. All rights reserved */
3
4#include <linux/debugfs.h>
5#include <linux/err.h>
6#include <linux/kernel.h>
7#include <linux/slab.h>
8
9#include "netdevsim.h"
10
11static int
12nsim_dev_empty_reporter_dump(struct devlink_health_reporter *reporter,
13 struct devlink_fmsg *fmsg, void *priv_ctx,
14 struct netlink_ext_ack *extack)
15{
16 return 0;
17}
18
19static int
20nsim_dev_empty_reporter_diagnose(struct devlink_health_reporter *reporter,
21 struct devlink_fmsg *fmsg,
22 struct netlink_ext_ack *extack)
23{
24 return 0;
25}
26
27static const
28struct devlink_health_reporter_ops nsim_dev_empty_reporter_ops = {
29 .name = "empty",
30 .dump = nsim_dev_empty_reporter_dump,
31 .diagnose = nsim_dev_empty_reporter_diagnose,
32};
33
34struct nsim_dev_dummy_reporter_ctx {
35 char *break_msg;
36};
37
38static int
39nsim_dev_dummy_reporter_recover(struct devlink_health_reporter *reporter,
40 void *priv_ctx,
41 struct netlink_ext_ack *extack)
42{
43 struct nsim_dev_health *health = devlink_health_reporter_priv(reporter);
44 struct nsim_dev_dummy_reporter_ctx *ctx = priv_ctx;
45
46 if (health->fail_recover) {
47 /* For testing purposes, user set debugfs fail_recover
48 * value to true. Fail right away.
49 */
50 NL_SET_ERR_MSG_MOD(extack, "User setup the recover to fail for testing purposes");
51 return -EINVAL;
52 }
53 if (ctx) {
54 kfree(health->recovered_break_msg);
55 health->recovered_break_msg = kstrdup(ctx->break_msg,
56 GFP_KERNEL);
57 if (!health->recovered_break_msg)
58 return -ENOMEM;
59 }
60 return 0;
61}
62
63static int nsim_dev_dummy_fmsg_put(struct devlink_fmsg *fmsg, u32 binary_len)
64{
65 char *binary;
66 int err;
67 int i;
68
69 err = devlink_fmsg_bool_pair_put(fmsg, "test_bool", true);
70 if (err)
71 return err;
72 err = devlink_fmsg_u8_pair_put(fmsg, "test_u8", 1);
73 if (err)
74 return err;
75 err = devlink_fmsg_u32_pair_put(fmsg, "test_u32", 3);
76 if (err)
77 return err;
78 err = devlink_fmsg_u64_pair_put(fmsg, "test_u64", 4);
79 if (err)
80 return err;
81 err = devlink_fmsg_string_pair_put(fmsg, "test_string", "somestring");
82 if (err)
83 return err;
84
85 binary = kmalloc(binary_len, GFP_KERNEL | __GFP_NOWARN);
86 if (!binary)
87 return -ENOMEM;
88 get_random_bytes(binary, binary_len);
89 err = devlink_fmsg_binary_pair_put(fmsg, "test_binary", binary, binary_len);
90 kfree(binary);
91 if (err)
92 return err;
93
94 err = devlink_fmsg_pair_nest_start(fmsg, "test_nest");
95 if (err)
96 return err;
97 err = devlink_fmsg_obj_nest_start(fmsg);
98 if (err)
99 return err;
100 err = devlink_fmsg_bool_pair_put(fmsg, "nested_test_bool", false);
101 if (err)
102 return err;
103 err = devlink_fmsg_u8_pair_put(fmsg, "nested_test_u8", false);
104 if (err)
105 return err;
106 err = devlink_fmsg_obj_nest_end(fmsg);
107 if (err)
108 return err;
109 err = devlink_fmsg_pair_nest_end(fmsg);
110 if (err)
111 return err;
112
113 err = devlink_fmsg_arr_pair_nest_end(fmsg);
114 if (err)
115 return err;
116
117 err = devlink_fmsg_arr_pair_nest_start(fmsg, "test_u32_array");
118 if (err)
119 return err;
120 for (i = 0; i < 10; i++) {
121 err = devlink_fmsg_u32_put(fmsg, i);
122 if (err)
123 return err;
124 }
125 err = devlink_fmsg_arr_pair_nest_end(fmsg);
126 if (err)
127 return err;
128
129 err = devlink_fmsg_arr_pair_nest_start(fmsg, "test_array_of_objects");
130 if (err)
131 return err;
132 for (i = 0; i < 10; i++) {
133 err = devlink_fmsg_obj_nest_start(fmsg);
134 if (err)
135 return err;
136 err = devlink_fmsg_bool_pair_put(fmsg,
137 "in_array_nested_test_bool",
138 false);
139 if (err)
140 return err;
141 err = devlink_fmsg_u8_pair_put(fmsg,
142 "in_array_nested_test_u8",
143 i);
144 if (err)
145 return err;
146 err = devlink_fmsg_obj_nest_end(fmsg);
147 if (err)
148 return err;
149 }
150 return devlink_fmsg_arr_pair_nest_end(fmsg);
151}
152
153static int
154nsim_dev_dummy_reporter_dump(struct devlink_health_reporter *reporter,
155 struct devlink_fmsg *fmsg, void *priv_ctx,
156 struct netlink_ext_ack *extack)
157{
158 struct nsim_dev_health *health = devlink_health_reporter_priv(reporter);
159 struct nsim_dev_dummy_reporter_ctx *ctx = priv_ctx;
160 int err;
161
162 if (ctx) {
163 err = devlink_fmsg_string_pair_put(fmsg, "break_message",
164 ctx->break_msg);
165 if (err)
166 return err;
167 }
168 return nsim_dev_dummy_fmsg_put(fmsg, health->binary_len);
169}
170
171static int
172nsim_dev_dummy_reporter_diagnose(struct devlink_health_reporter *reporter,
173 struct devlink_fmsg *fmsg,
174 struct netlink_ext_ack *extack)
175{
176 struct nsim_dev_health *health = devlink_health_reporter_priv(reporter);
177 int err;
178
179 if (health->recovered_break_msg) {
180 err = devlink_fmsg_string_pair_put(fmsg,
181 "recovered_break_message",
182 health->recovered_break_msg);
183 if (err)
184 return err;
185 }
186 return nsim_dev_dummy_fmsg_put(fmsg, health->binary_len);
187}
188
189static const
190struct devlink_health_reporter_ops nsim_dev_dummy_reporter_ops = {
191 .name = "dummy",
192 .recover = nsim_dev_dummy_reporter_recover,
193 .dump = nsim_dev_dummy_reporter_dump,
194 .diagnose = nsim_dev_dummy_reporter_diagnose,
195};
196
197static ssize_t nsim_dev_health_break_write(struct file *file,
198 const char __user *data,
199 size_t count, loff_t *ppos)
200{
201 struct nsim_dev_health *health = file->private_data;
202 struct nsim_dev_dummy_reporter_ctx ctx;
203 char *break_msg;
204 int err;
205
206 break_msg = memdup_user_nul(data, count);
207 if (IS_ERR(break_msg))
208 return PTR_ERR(break_msg);
209
210 if (break_msg[count - 1] == '\n')
211 break_msg[count - 1] = '\0';
212
213 ctx.break_msg = break_msg;
214 err = devlink_health_report(health->dummy_reporter, break_msg, &ctx);
215 if (err)
216 goto out;
217
218out:
219 kfree(break_msg);
220 return err ?: count;
221}
222
223static const struct file_operations nsim_dev_health_break_fops = {
224 .open = simple_open,
225 .write = nsim_dev_health_break_write,
226 .llseek = generic_file_llseek,
227 .owner = THIS_MODULE,
228};
229
230int nsim_dev_health_init(struct nsim_dev *nsim_dev, struct devlink *devlink)
231{
232 struct nsim_dev_health *health = &nsim_dev->health;
233 int err;
234
235 health->empty_reporter =
236 devlink_health_reporter_create(devlink,
237 &nsim_dev_empty_reporter_ops,
238 0, health);
239 if (IS_ERR(health->empty_reporter))
240 return PTR_ERR(health->empty_reporter);
241
242 health->dummy_reporter =
243 devlink_health_reporter_create(devlink,
244 &nsim_dev_dummy_reporter_ops,
245 0, health);
246 if (IS_ERR(health->dummy_reporter)) {
247 err = PTR_ERR(health->dummy_reporter);
248 goto err_empty_reporter_destroy;
249 }
250
251 health->ddir = debugfs_create_dir("health", nsim_dev->ddir);
252 if (IS_ERR(health->ddir)) {
253 err = PTR_ERR(health->ddir);
254 goto err_dummy_reporter_destroy;
255 }
256
257 health->recovered_break_msg = NULL;
258 debugfs_create_file("break_health", 0200, health->ddir, health,
259 &nsim_dev_health_break_fops);
260 health->binary_len = 16;
261 debugfs_create_u32("binary_len", 0600, health->ddir,
262 &health->binary_len);
263 health->fail_recover = false;
264 debugfs_create_bool("fail_recover", 0600, health->ddir,
265 &health->fail_recover);
266 return 0;
267
268err_dummy_reporter_destroy:
269 devlink_health_reporter_destroy(health->dummy_reporter);
270err_empty_reporter_destroy:
271 devlink_health_reporter_destroy(health->empty_reporter);
272 return err;
273}
274
275void nsim_dev_health_exit(struct nsim_dev *nsim_dev)
276{
277 struct nsim_dev_health *health = &nsim_dev->health;
278
279 debugfs_remove_recursive(health->ddir);
280 kfree(health->recovered_break_msg);
281 devlink_health_reporter_destroy(health->dummy_reporter);
282 devlink_health_reporter_destroy(health->empty_reporter);
283}