1165c3c9fSDirk van der Merwe// SPDX-License-Identifier: (GPL-2.0-only OR BSD-2-Clause)
2165c3c9fSDirk van der Merwe/* Copyright (C) 2019 Netronome Systems, Inc. */
3165c3c9fSDirk van der Merwe
4165c3c9fSDirk van der Merwe#include <net/devlink.h>
5165c3c9fSDirk van der Merwe
6ff04788cSDirk van der Merwe#include "nfpcore/nfp.h"
7165c3c9fSDirk van der Merwe#include "nfpcore/nfp_nsp.h"
8165c3c9fSDirk van der Merwe#include "nfp_main.h"
9165c3c9fSDirk van der Merwe
10ff04788cSDirk van der Merwe/**
11ff04788cSDirk van der Merwe * struct nfp_devlink_param_u8_arg - Devlink u8 parameter get/set arguments
12ff04788cSDirk van der Merwe * @hwinfo_name:	HWinfo key name
13ff04788cSDirk van der Merwe * @default_hi_val:	Default HWinfo value if HWinfo doesn't exist
14ff04788cSDirk van der Merwe * @invalid_dl_val:	Devlink value to use if HWinfo is unknown/invalid.
15ff04788cSDirk van der Merwe *			-errno if there is no unknown/invalid value available
16ff04788cSDirk van der Merwe * @hi_to_dl:	HWinfo to devlink value mapping
17ff04788cSDirk van der Merwe * @dl_to_hi:	Devlink to hwinfo value mapping
18ff04788cSDirk van der Merwe * @max_dl_val:	Maximum devlink value supported, for validation only
19ff04788cSDirk van der Merwe * @max_hi_val:	Maximum HWinfo value supported, for validation only
20ff04788cSDirk van der Merwe */
21ff04788cSDirk van der Merwestruct nfp_devlink_param_u8_arg {
22ff04788cSDirk van der Merwe	const char *hwinfo_name;
23ff04788cSDirk van der Merwe	const char *default_hi_val;
24ff04788cSDirk van der Merwe	int invalid_dl_val;
25ff04788cSDirk van der Merwe	u8 hi_to_dl[4];
26ff04788cSDirk van der Merwe	u8 dl_to_hi[4];
27ff04788cSDirk van der Merwe	u8 max_dl_val;
28ff04788cSDirk van der Merwe	u8 max_hi_val;
29ff04788cSDirk van der Merwe};
30ff04788cSDirk van der Merwe
31ff04788cSDirk van der Merwestatic const struct nfp_devlink_param_u8_arg nfp_devlink_u8_args[] = {
32ff04788cSDirk van der Merwe	[DEVLINK_PARAM_GENERIC_ID_FW_LOAD_POLICY] = {
33ff04788cSDirk van der Merwe		.hwinfo_name = "app_fw_from_flash",
34ff04788cSDirk van der Merwe		.default_hi_val = NFP_NSP_APP_FW_LOAD_DEFAULT,
3544798eceSDirk van der Merwe		.invalid_dl_val =
3644798eceSDirk van der Merwe			DEVLINK_PARAM_FW_LOAD_POLICY_VALUE_UNKNOWN,
37ff04788cSDirk van der Merwe		.hi_to_dl = {
38ff04788cSDirk van der Merwe			[NFP_NSP_APP_FW_LOAD_DISK] =
39ff04788cSDirk van der Merwe				DEVLINK_PARAM_FW_LOAD_POLICY_VALUE_DISK,
40ff04788cSDirk van der Merwe			[NFP_NSP_APP_FW_LOAD_FLASH] =
41ff04788cSDirk van der Merwe				DEVLINK_PARAM_FW_LOAD_POLICY_VALUE_FLASH,
42ff04788cSDirk van der Merwe			[NFP_NSP_APP_FW_LOAD_PREF] =
43ff04788cSDirk van der Merwe				DEVLINK_PARAM_FW_LOAD_POLICY_VALUE_DRIVER,
44ff04788cSDirk van der Merwe		},
45ff04788cSDirk van der Merwe		.dl_to_hi = {
46ff04788cSDirk van der Merwe			[DEVLINK_PARAM_FW_LOAD_POLICY_VALUE_DRIVER] =
47ff04788cSDirk van der Merwe				NFP_NSP_APP_FW_LOAD_PREF,
48ff04788cSDirk van der Merwe			[DEVLINK_PARAM_FW_LOAD_POLICY_VALUE_FLASH] =
49ff04788cSDirk van der Merwe				NFP_NSP_APP_FW_LOAD_FLASH,
50ff04788cSDirk van der Merwe			[DEVLINK_PARAM_FW_LOAD_POLICY_VALUE_DISK] =
51ff04788cSDirk van der Merwe				NFP_NSP_APP_FW_LOAD_DISK,
52ff04788cSDirk van der Merwe		},
53ff04788cSDirk van der Merwe		.max_dl_val = DEVLINK_PARAM_FW_LOAD_POLICY_VALUE_DISK,
54ff04788cSDirk van der Merwe		.max_hi_val = NFP_NSP_APP_FW_LOAD_PREF,
55ff04788cSDirk van der Merwe	},
560fbee0ecSDirk van der Merwe	[DEVLINK_PARAM_GENERIC_ID_RESET_DEV_ON_DRV_PROBE] = {
570fbee0ecSDirk van der Merwe		.hwinfo_name = "abi_drv_reset",
580fbee0ecSDirk van der Merwe		.default_hi_val = NFP_NSP_DRV_RESET_DEFAULT,
590fbee0ecSDirk van der Merwe		.invalid_dl_val =
600fbee0ecSDirk van der Merwe			DEVLINK_PARAM_RESET_DEV_ON_DRV_PROBE_VALUE_UNKNOWN,
610fbee0ecSDirk van der Merwe		.hi_to_dl = {
620fbee0ecSDirk van der Merwe			[NFP_NSP_DRV_RESET_ALWAYS] =
630fbee0ecSDirk van der Merwe				DEVLINK_PARAM_RESET_DEV_ON_DRV_PROBE_VALUE_ALWAYS,
640fbee0ecSDirk van der Merwe			[NFP_NSP_DRV_RESET_NEVER] =
650fbee0ecSDirk van der Merwe				DEVLINK_PARAM_RESET_DEV_ON_DRV_PROBE_VALUE_NEVER,
660fbee0ecSDirk van der Merwe			[NFP_NSP_DRV_RESET_DISK] =
670fbee0ecSDirk van der Merwe				DEVLINK_PARAM_RESET_DEV_ON_DRV_PROBE_VALUE_DISK,
680fbee0ecSDirk van der Merwe		},
690fbee0ecSDirk van der Merwe		.dl_to_hi = {
700fbee0ecSDirk van der Merwe			[DEVLINK_PARAM_RESET_DEV_ON_DRV_PROBE_VALUE_ALWAYS] =
710fbee0ecSDirk van der Merwe				NFP_NSP_DRV_RESET_ALWAYS,
720fbee0ecSDirk van der Merwe			[DEVLINK_PARAM_RESET_DEV_ON_DRV_PROBE_VALUE_NEVER] =
730fbee0ecSDirk van der Merwe				NFP_NSP_DRV_RESET_NEVER,
740fbee0ecSDirk van der Merwe			[DEVLINK_PARAM_RESET_DEV_ON_DRV_PROBE_VALUE_DISK] =
750fbee0ecSDirk van der Merwe				NFP_NSP_DRV_RESET_DISK,
760fbee0ecSDirk van der Merwe		},
770fbee0ecSDirk van der Merwe		.max_dl_val = DEVLINK_PARAM_RESET_DEV_ON_DRV_PROBE_VALUE_DISK,
780fbee0ecSDirk van der Merwe		.max_hi_val = NFP_NSP_DRV_RESET_NEVER,
790fbee0ecSDirk van der Merwe	}
80ff04788cSDirk van der Merwe};
81ff04788cSDirk van der Merwe
82ff04788cSDirk van der Merwestatic int
83ff04788cSDirk van der Merwenfp_devlink_param_u8_get(struct devlink *devlink, u32 id,
84ff04788cSDirk van der Merwe			 struct devlink_param_gset_ctx *ctx)
85ff04788cSDirk van der Merwe{
86ff04788cSDirk van der Merwe	const struct nfp_devlink_param_u8_arg *arg;
87ff04788cSDirk van der Merwe	struct nfp_pf *pf = devlink_priv(devlink);
88ff04788cSDirk van der Merwe	struct nfp_nsp *nsp;
89ff04788cSDirk van der Merwe	char hwinfo[32];
90ff04788cSDirk van der Merwe	long value;
91ff04788cSDirk van der Merwe	int err;
92ff04788cSDirk van der Merwe
93ff04788cSDirk van der Merwe	if (id >= ARRAY_SIZE(nfp_devlink_u8_args))
94ff04788cSDirk van der Merwe		return -EOPNOTSUPP;
95ff04788cSDirk van der Merwe
96ff04788cSDirk van der Merwe	arg = &nfp_devlink_u8_args[id];
97ff04788cSDirk van der Merwe
98ff04788cSDirk van der Merwe	nsp = nfp_nsp_open(pf->cpp);
99ff04788cSDirk van der Merwe	if (IS_ERR(nsp)) {
100ff04788cSDirk van der Merwe		err = PTR_ERR(nsp);
101ff04788cSDirk van der Merwe		nfp_warn(pf->cpp, "can't access NSP: %d\n", err);
102ff04788cSDirk van der Merwe		return err;
103ff04788cSDirk van der Merwe	}
104ff04788cSDirk van der Merwe
105ff04788cSDirk van der Merwe	snprintf(hwinfo, sizeof(hwinfo), arg->hwinfo_name);
106ff04788cSDirk van der Merwe	err = nfp_nsp_hwinfo_lookup_optional(nsp, hwinfo, sizeof(hwinfo),
107ff04788cSDirk van der Merwe					     arg->default_hi_val);
108ff04788cSDirk van der Merwe	if (err) {
109ff04788cSDirk van der Merwe		nfp_warn(pf->cpp, "HWinfo lookup failed: %d\n", err);
110ff04788cSDirk van der Merwe		goto exit_close_nsp;
111ff04788cSDirk van der Merwe	}
112ff04788cSDirk van der Merwe
113ff04788cSDirk van der Merwe	err = kstrtol(hwinfo, 0, &value);
114ff04788cSDirk van der Merwe	if (err || value < 0 || value > arg->max_hi_val) {
115ff04788cSDirk van der Merwe		nfp_warn(pf->cpp, "HWinfo '%s' value %li invalid\n",
116ff04788cSDirk van der Merwe			 arg->hwinfo_name, value);
117ff04788cSDirk van der Merwe
118ff04788cSDirk van der Merwe		if (arg->invalid_dl_val >= 0)
119ff04788cSDirk van der Merwe			ctx->val.vu8 = arg->invalid_dl_val;
120ff04788cSDirk van der Merwe		else
121ff04788cSDirk van der Merwe			err = arg->invalid_dl_val;
122ff04788cSDirk van der Merwe
123ff04788cSDirk van der Merwe		goto exit_close_nsp;
124ff04788cSDirk van der Merwe	}
125ff04788cSDirk van der Merwe
126ff04788cSDirk van der Merwe	ctx->val.vu8 = arg->hi_to_dl[value];
127ff04788cSDirk van der Merwe
128ff04788cSDirk van der Merweexit_close_nsp:
129ff04788cSDirk van der Merwe	nfp_nsp_close(nsp);
130ff04788cSDirk van der Merwe	return err;
131ff04788cSDirk van der Merwe}
132ff04788cSDirk van der Merwe
133ff04788cSDirk van der Merwestatic int
134ff04788cSDirk van der Merwenfp_devlink_param_u8_set(struct devlink *devlink, u32 id,
135ff04788cSDirk van der Merwe			 struct devlink_param_gset_ctx *ctx)
136ff04788cSDirk van der Merwe{
137ff04788cSDirk van der Merwe	const struct nfp_devlink_param_u8_arg *arg;
138ff04788cSDirk van der Merwe	struct nfp_pf *pf = devlink_priv(devlink);
139ff04788cSDirk van der Merwe	struct nfp_nsp *nsp;
140ff04788cSDirk van der Merwe	char hwinfo[32];
141ff04788cSDirk van der Merwe	int err;
142ff04788cSDirk van der Merwe
143ff04788cSDirk van der Merwe	if (id >= ARRAY_SIZE(nfp_devlink_u8_args))
144ff04788cSDirk van der Merwe		return -EOPNOTSUPP;
145ff04788cSDirk van der Merwe
146ff04788cSDirk van der Merwe	arg = &nfp_devlink_u8_args[id];
147ff04788cSDirk van der Merwe
148ff04788cSDirk van der Merwe	nsp = nfp_nsp_open(pf->cpp);
149ff04788cSDirk van der Merwe	if (IS_ERR(nsp)) {
150ff04788cSDirk van der Merwe		err = PTR_ERR(nsp);
151ff04788cSDirk van der Merwe		nfp_warn(pf->cpp, "can't access NSP: %d\n", err);
152ff04788cSDirk van der Merwe		return err;
153ff04788cSDirk van der Merwe	}
154ff04788cSDirk van der Merwe
155ff04788cSDirk van der Merwe	/* Note the value has already been validated. */
156ff04788cSDirk van der Merwe	snprintf(hwinfo, sizeof(hwinfo), "%s=%u",
157ff04788cSDirk van der Merwe		 arg->hwinfo_name, arg->dl_to_hi[ctx->val.vu8]);
158ff04788cSDirk van der Merwe	err = nfp_nsp_hwinfo_set(nsp, hwinfo, sizeof(hwinfo));
159ff04788cSDirk van der Merwe	if (err) {
160ff04788cSDirk van der Merwe		nfp_warn(pf->cpp, "HWinfo set failed: %d\n", err);
161ff04788cSDirk van der Merwe		goto exit_close_nsp;
162ff04788cSDirk van der Merwe	}
163ff04788cSDirk van der Merwe
164ff04788cSDirk van der Merweexit_close_nsp:
165ff04788cSDirk van der Merwe	nfp_nsp_close(nsp);
166ff04788cSDirk van der Merwe	return err;
167ff04788cSDirk van der Merwe}
168ff04788cSDirk van der Merwe
169ff04788cSDirk van der Merwestatic int
170ff04788cSDirk van der Merwenfp_devlink_param_u8_validate(struct devlink *devlink, u32 id,
171ff04788cSDirk van der Merwe			      union devlink_param_value val,
172ff04788cSDirk van der Merwe			      struct netlink_ext_ack *extack)
173ff04788cSDirk van der Merwe{
174ff04788cSDirk van der Merwe	const struct nfp_devlink_param_u8_arg *arg;
175ff04788cSDirk van der Merwe
176ff04788cSDirk van der Merwe	if (id >= ARRAY_SIZE(nfp_devlink_u8_args))
177ff04788cSDirk van der Merwe		return -EOPNOTSUPP;
178ff04788cSDirk van der Merwe
179ff04788cSDirk van der Merwe	arg = &nfp_devlink_u8_args[id];
180ff04788cSDirk van der Merwe
181ff04788cSDirk van der Merwe	if (val.vu8 > arg->max_dl_val) {
182ff04788cSDirk van der Merwe		NL_SET_ERR_MSG_MOD(extack, "parameter out of range");
183ff04788cSDirk van der Merwe		return -EINVAL;
184ff04788cSDirk van der Merwe	}
185ff04788cSDirk van der Merwe
186ff04788cSDirk van der Merwe	if (val.vu8 == arg->invalid_dl_val) {
187ff04788cSDirk van der Merwe		NL_SET_ERR_MSG_MOD(extack, "unknown/invalid value specified");
188ff04788cSDirk van der Merwe		return -EINVAL;
189ff04788cSDirk van der Merwe	}
190ff04788cSDirk van der Merwe
191ff04788cSDirk van der Merwe	return 0;
192ff04788cSDirk van der Merwe}
193ff04788cSDirk van der Merwe
194165c3c9fSDirk van der Merwestatic const struct devlink_param nfp_devlink_params[] = {
195ff04788cSDirk van der Merwe	DEVLINK_PARAM_GENERIC(FW_LOAD_POLICY,
196ff04788cSDirk van der Merwe			      BIT(DEVLINK_PARAM_CMODE_PERMANENT),
197ff04788cSDirk van der Merwe			      nfp_devlink_param_u8_get,
198ff04788cSDirk van der Merwe			      nfp_devlink_param_u8_set,
199ff04788cSDirk van der Merwe			      nfp_devlink_param_u8_validate),
2000fbee0ecSDirk van der Merwe	DEVLINK_PARAM_GENERIC(RESET_DEV_ON_DRV_PROBE,
2010fbee0ecSDirk van der Merwe			      BIT(DEVLINK_PARAM_CMODE_PERMANENT),
2020fbee0ecSDirk van der Merwe			      nfp_devlink_param_u8_get,
2030fbee0ecSDirk van der Merwe			      nfp_devlink_param_u8_set,
2040fbee0ecSDirk van der Merwe			      nfp_devlink_param_u8_validate),
205165c3c9fSDirk van der Merwe};
206165c3c9fSDirk van der Merwe
207165c3c9fSDirk van der Merwestatic int nfp_devlink_supports_params(struct nfp_pf *pf)
208165c3c9fSDirk van der Merwe{
209165c3c9fSDirk van der Merwe	struct nfp_nsp *nsp;
210165c3c9fSDirk van der Merwe	bool supported;
211165c3c9fSDirk van der Merwe	int err;
212165c3c9fSDirk van der Merwe
213165c3c9fSDirk van der Merwe	nsp = nfp_nsp_open(pf->cpp);
214165c3c9fSDirk van der Merwe	if (IS_ERR(nsp)) {
215165c3c9fSDirk van der Merwe		err = PTR_ERR(nsp);
216165c3c9fSDirk van der Merwe		dev_err(&pf->pdev->dev, "Failed to access the NSP: %d\n", err);
217165c3c9fSDirk van der Merwe		return err;
218165c3c9fSDirk van der Merwe	}
219165c3c9fSDirk van der Merwe
220165c3c9fSDirk van der Merwe	supported = nfp_nsp_has_hwinfo_lookup(nsp) &&
221165c3c9fSDirk van der Merwe		    nfp_nsp_has_hwinfo_set(nsp);
222165c3c9fSDirk van der Merwe
223165c3c9fSDirk van der Merwe	nfp_nsp_close(nsp);
224165c3c9fSDirk van der Merwe	return supported;
225165c3c9fSDirk van der Merwe}
226165c3c9fSDirk van der Merwe
227165c3c9fSDirk van der Merweint nfp_devlink_params_register(struct nfp_pf *pf)
228165c3c9fSDirk van der Merwe{
229165c3c9fSDirk van der Merwe	struct devlink *devlink = priv_to_devlink(pf);
230165c3c9fSDirk van der Merwe	int err;
231165c3c9fSDirk van der Merwe
232165c3c9fSDirk van der Merwe	err = nfp_devlink_supports_params(pf);
233165c3c9fSDirk van der Merwe	if (err <= 0)
234165c3c9fSDirk van der Merwe		return err;
235165c3c9fSDirk van der Merwe
2364f2a81c4SLeon Romanovsky	return devlink_params_register(devlink, nfp_devlink_params,
2374f2a81c4SLeon Romanovsky				       ARRAY_SIZE(nfp_devlink_params));
238165c3c9fSDirk van der Merwe}
239165c3c9fSDirk van der Merwe
240165c3c9fSDirk van der Merwevoid nfp_devlink_params_unregister(struct nfp_pf *pf)
241165c3c9fSDirk van der Merwe{
242165c3c9fSDirk van der Merwe	int err;
243165c3c9fSDirk van der Merwe
244165c3c9fSDirk van der Merwe	err = nfp_devlink_supports_params(pf);
245165c3c9fSDirk van der Merwe	if (err <= 0)
246165c3c9fSDirk van der Merwe		return;
247165c3c9fSDirk van der Merwe
248165c3c9fSDirk van der Merwe	devlink_params_unregister(priv_to_devlink(pf), nfp_devlink_params,
249165c3c9fSDirk van der Merwe				  ARRAY_SIZE(nfp_devlink_params));
250165c3c9fSDirk van der Merwe}
251