1 // SPDX-License-Identifier: GPL-2.0-only
2 /* Copyright (C) 2021 Marvell. */
3
4 #include "otx2_cpt_devlink.h"
5
otx2_cpt_dl_egrp_create(struct devlink * dl,u32 id,struct devlink_param_gset_ctx * ctx)6 static int otx2_cpt_dl_egrp_create(struct devlink *dl, u32 id,
7 struct devlink_param_gset_ctx *ctx)
8 {
9 struct otx2_cpt_devlink *cpt_dl = devlink_priv(dl);
10 struct otx2_cptpf_dev *cptpf = cpt_dl->cptpf;
11
12 return otx2_cpt_dl_custom_egrp_create(cptpf, ctx);
13 }
14
otx2_cpt_dl_egrp_delete(struct devlink * dl,u32 id,struct devlink_param_gset_ctx * ctx)15 static int otx2_cpt_dl_egrp_delete(struct devlink *dl, u32 id,
16 struct devlink_param_gset_ctx *ctx)
17 {
18 struct otx2_cpt_devlink *cpt_dl = devlink_priv(dl);
19 struct otx2_cptpf_dev *cptpf = cpt_dl->cptpf;
20
21 return otx2_cpt_dl_custom_egrp_delete(cptpf, ctx);
22 }
23
otx2_cpt_dl_uc_info(struct devlink * dl,u32 id,struct devlink_param_gset_ctx * ctx)24 static int otx2_cpt_dl_uc_info(struct devlink *dl, u32 id,
25 struct devlink_param_gset_ctx *ctx)
26 {
27 struct otx2_cpt_devlink *cpt_dl = devlink_priv(dl);
28 struct otx2_cptpf_dev *cptpf = cpt_dl->cptpf;
29
30 otx2_cpt_print_uc_dbg_info(cptpf);
31
32 return 0;
33 }
34
35 enum otx2_cpt_dl_param_id {
36 OTX2_CPT_DEVLINK_PARAM_ID_BASE = DEVLINK_PARAM_GENERIC_ID_MAX,
37 OTX2_CPT_DEVLINK_PARAM_ID_EGRP_CREATE,
38 OTX2_CPT_DEVLINK_PARAM_ID_EGRP_DELETE,
39 };
40
41 static const struct devlink_param otx2_cpt_dl_params[] = {
42 DEVLINK_PARAM_DRIVER(OTX2_CPT_DEVLINK_PARAM_ID_EGRP_CREATE,
43 "egrp_create", DEVLINK_PARAM_TYPE_STRING,
44 BIT(DEVLINK_PARAM_CMODE_RUNTIME),
45 otx2_cpt_dl_uc_info, otx2_cpt_dl_egrp_create,
46 NULL),
47 DEVLINK_PARAM_DRIVER(OTX2_CPT_DEVLINK_PARAM_ID_EGRP_DELETE,
48 "egrp_delete", DEVLINK_PARAM_TYPE_STRING,
49 BIT(DEVLINK_PARAM_CMODE_RUNTIME),
50 otx2_cpt_dl_uc_info, otx2_cpt_dl_egrp_delete,
51 NULL),
52 };
53
otx2_cpt_dl_info_firmware_version_put(struct devlink_info_req * req,struct otx2_cpt_eng_grp_info grp[],const char * ver_name,int eng_type)54 static int otx2_cpt_dl_info_firmware_version_put(struct devlink_info_req *req,
55 struct otx2_cpt_eng_grp_info grp[],
56 const char *ver_name, int eng_type)
57 {
58 struct otx2_cpt_engs_rsvd *eng;
59 int i;
60
61 for (i = 0; i < OTX2_CPT_MAX_ENGINE_GROUPS; i++) {
62 eng = find_engines_by_type(&grp[i], eng_type);
63 if (eng)
64 return devlink_info_version_running_put(req, ver_name,
65 eng->ucode->ver_str);
66 }
67
68 return 0;
69 }
70
otx2_cpt_devlink_info_get(struct devlink * dl,struct devlink_info_req * req,struct netlink_ext_ack * extack)71 static int otx2_cpt_devlink_info_get(struct devlink *dl,
72 struct devlink_info_req *req,
73 struct netlink_ext_ack *extack)
74 {
75 struct otx2_cpt_devlink *cpt_dl = devlink_priv(dl);
76 struct otx2_cptpf_dev *cptpf = cpt_dl->cptpf;
77 int err;
78
79 err = otx2_cpt_dl_info_firmware_version_put(req, cptpf->eng_grps.grp,
80 "fw.ae", OTX2_CPT_AE_TYPES);
81 if (err)
82 return err;
83
84 err = otx2_cpt_dl_info_firmware_version_put(req, cptpf->eng_grps.grp,
85 "fw.se", OTX2_CPT_SE_TYPES);
86 if (err)
87 return err;
88
89 return otx2_cpt_dl_info_firmware_version_put(req, cptpf->eng_grps.grp,
90 "fw.ie", OTX2_CPT_IE_TYPES);
91 }
92
93 static const struct devlink_ops otx2_cpt_devlink_ops = {
94 .info_get = otx2_cpt_devlink_info_get,
95 };
96
otx2_cpt_register_dl(struct otx2_cptpf_dev * cptpf)97 int otx2_cpt_register_dl(struct otx2_cptpf_dev *cptpf)
98 {
99 struct device *dev = &cptpf->pdev->dev;
100 struct otx2_cpt_devlink *cpt_dl;
101 struct devlink *dl;
102 int ret;
103
104 dl = devlink_alloc(&otx2_cpt_devlink_ops,
105 sizeof(struct otx2_cpt_devlink), dev);
106 if (!dl) {
107 dev_warn(dev, "devlink_alloc failed\n");
108 return -ENOMEM;
109 }
110
111 cpt_dl = devlink_priv(dl);
112 cpt_dl->dl = dl;
113 cpt_dl->cptpf = cptpf;
114 cptpf->dl = dl;
115 ret = devlink_params_register(dl, otx2_cpt_dl_params,
116 ARRAY_SIZE(otx2_cpt_dl_params));
117 if (ret) {
118 dev_err(dev, "devlink params register failed with error %d",
119 ret);
120 devlink_free(dl);
121 return ret;
122 }
123
124 devlink_register(dl);
125
126 return 0;
127 }
128
otx2_cpt_unregister_dl(struct otx2_cptpf_dev * cptpf)129 void otx2_cpt_unregister_dl(struct otx2_cptpf_dev *cptpf)
130 {
131 struct devlink *dl = cptpf->dl;
132
133 if (!dl)
134 return;
135
136 devlink_unregister(dl);
137 devlink_params_unregister(dl, otx2_cpt_dl_params,
138 ARRAY_SIZE(otx2_cpt_dl_params));
139 devlink_free(dl);
140 }
141