]>
Commit | Line | Data |
---|---|---|
0cdbdd3e SM |
1 | // SPDX-License-Identifier: GPL-2.0+ |
2 | // Copyright (c) 2016-2017 Hisilicon Limited. | |
3 | ||
4 | #include "hclge_main.h" | |
5 | #include "hclge_mbx.h" | |
6 | #include "hnae3.h" | |
7 | ||
8 | /* hclge_gen_resp_to_vf: used to generate a synchronous response to VF when PF | |
9 | * receives a mailbox message from VF. | |
10 | * @vport: pointer to struct hclge_vport | |
11 | * @vf_to_pf_req: pointer to hclge_mbx_vf_to_pf_cmd of the original mailbox | |
12 | * message | |
13 | * @resp_status: indicate to VF whether its request success(0) or failed. | |
14 | */ | |
15 | static int hclge_gen_resp_to_vf(struct hclge_vport *vport, | |
16 | struct hclge_mbx_vf_to_pf_cmd *vf_to_pf_req, | |
17 | int resp_status, | |
18 | u8 *resp_data, u16 resp_data_len) | |
19 | { | |
20 | struct hclge_mbx_pf_to_vf_cmd *resp_pf_to_vf; | |
21 | struct hclge_dev *hdev = vport->back; | |
22 | enum hclge_cmd_status status; | |
23 | struct hclge_desc desc; | |
24 | ||
25 | resp_pf_to_vf = (struct hclge_mbx_pf_to_vf_cmd *)desc.data; | |
26 | ||
27 | if (resp_data_len > HCLGE_MBX_MAX_RESP_DATA_SIZE) { | |
28 | dev_err(&hdev->pdev->dev, | |
29 | "PF fail to gen resp to VF len %d exceeds max len %d\n", | |
30 | resp_data_len, | |
31 | HCLGE_MBX_MAX_RESP_DATA_SIZE); | |
32 | } | |
33 | ||
34 | hclge_cmd_setup_basic_desc(&desc, HCLGEVF_OPC_MBX_PF_TO_VF, false); | |
35 | ||
36 | resp_pf_to_vf->dest_vfid = vf_to_pf_req->mbx_src_vfid; | |
37 | resp_pf_to_vf->msg_len = vf_to_pf_req->msg_len; | |
38 | ||
39 | resp_pf_to_vf->msg[0] = HCLGE_MBX_PF_VF_RESP; | |
40 | resp_pf_to_vf->msg[1] = vf_to_pf_req->msg[0]; | |
41 | resp_pf_to_vf->msg[2] = vf_to_pf_req->msg[1]; | |
42 | resp_pf_to_vf->msg[3] = (resp_status == 0) ? 0 : 1; | |
43 | ||
44 | if (resp_data && resp_data_len > 0) | |
45 | memcpy(&resp_pf_to_vf->msg[4], resp_data, resp_data_len); | |
46 | ||
47 | status = hclge_cmd_send(&hdev->hw, &desc, 1); | |
48 | if (status) | |
49 | dev_err(&hdev->pdev->dev, | |
50 | "PF failed(=%d) to send response to VF\n", status); | |
51 | ||
52 | return status; | |
53 | } | |
54 | ||
55 | static int hclge_send_mbx_msg(struct hclge_vport *vport, u8 *msg, u16 msg_len, | |
56 | u16 mbx_opcode, u8 dest_vfid) | |
57 | { | |
58 | struct hclge_mbx_pf_to_vf_cmd *resp_pf_to_vf; | |
59 | struct hclge_dev *hdev = vport->back; | |
60 | enum hclge_cmd_status status; | |
61 | struct hclge_desc desc; | |
62 | ||
63 | resp_pf_to_vf = (struct hclge_mbx_pf_to_vf_cmd *)desc.data; | |
64 | ||
65 | hclge_cmd_setup_basic_desc(&desc, HCLGEVF_OPC_MBX_PF_TO_VF, false); | |
66 | ||
67 | resp_pf_to_vf->dest_vfid = dest_vfid; | |
68 | resp_pf_to_vf->msg_len = msg_len; | |
69 | resp_pf_to_vf->msg[0] = mbx_opcode; | |
70 | ||
71 | memcpy(&resp_pf_to_vf->msg[1], msg, msg_len); | |
72 | ||
73 | status = hclge_cmd_send(&hdev->hw, &desc, 1); | |
74 | if (status) | |
75 | dev_err(&hdev->pdev->dev, | |
76 | "PF failed(=%d) to send mailbox message to VF\n", | |
77 | status); | |
78 | ||
79 | return status; | |
80 | } | |
81 | ||
63d7e66f SM |
82 | static void hclge_free_vector_ring_chain(struct hnae3_ring_chain_node *head) |
83 | { | |
84 | struct hnae3_ring_chain_node *chain_tmp, *chain; | |
85 | ||
86 | chain = head->next; | |
87 | ||
88 | while (chain) { | |
89 | chain_tmp = chain->next; | |
90 | kzfree(chain); | |
91 | chain = chain_tmp; | |
92 | } | |
93 | } | |
94 | ||
95 | /* hclge_get_ring_chain_from_mbx: get ring type & tqpid from mailbox message | |
96 | * msg[0]: opcode | |
97 | * msg[1]: <not relevant to this function> | |
98 | * msg[2]: ring_num | |
99 | * msg[3]: first ring type (TX|RX) | |
100 | * msg[4]: first tqp id | |
101 | * msg[5] ~ msg[14]: other ring type and tqp id | |
102 | */ | |
103 | static int hclge_get_ring_chain_from_mbx( | |
104 | struct hclge_mbx_vf_to_pf_cmd *req, | |
105 | struct hnae3_ring_chain_node *ring_chain, | |
106 | struct hclge_vport *vport) | |
107 | { | |
63d7e66f SM |
108 | struct hnae3_ring_chain_node *cur_chain, *new_chain; |
109 | int ring_num; | |
110 | int i; | |
111 | ||
112 | ring_num = req->msg[2]; | |
113 | ||
ce50439a YL |
114 | if (ring_num > ((HCLGE_MBX_VF_MSG_DATA_NUM - |
115 | HCLGE_MBX_RING_MAP_BASIC_MSG_NUM) / | |
116 | HCLGE_MBX_RING_NODE_VARIABLE_NUM)) | |
117 | return -ENOMEM; | |
118 | ||
63d7e66f SM |
119 | hnae_set_bit(ring_chain->flag, HNAE3_RING_TYPE_B, req->msg[3]); |
120 | ring_chain->tqp_index = | |
121 | hclge_get_queue_id(vport->nic.kinfo.tqp[req->msg[4]]); | |
b385cfd8 FL |
122 | hnae_set_field(ring_chain->int_gl_idx, HCLGE_INT_GL_IDX_M, |
123 | HCLGE_INT_GL_IDX_S, | |
124 | req->msg[5]); | |
63d7e66f SM |
125 | |
126 | cur_chain = ring_chain; | |
127 | ||
128 | for (i = 1; i < ring_num; i++) { | |
129 | new_chain = kzalloc(sizeof(*new_chain), GFP_KERNEL); | |
130 | if (!new_chain) | |
131 | goto err; | |
132 | ||
133 | hnae_set_bit(new_chain->flag, HNAE3_RING_TYPE_B, | |
ce50439a YL |
134 | req->msg[HCLGE_MBX_RING_NODE_VARIABLE_NUM * i + |
135 | HCLGE_MBX_RING_MAP_BASIC_MSG_NUM]); | |
63d7e66f SM |
136 | |
137 | new_chain->tqp_index = | |
138 | hclge_get_queue_id(vport->nic.kinfo.tqp | |
ce50439a YL |
139 | [req->msg[HCLGE_MBX_RING_NODE_VARIABLE_NUM * i + |
140 | HCLGE_MBX_RING_MAP_BASIC_MSG_NUM + 1]]); | |
63d7e66f | 141 | |
b385cfd8 FL |
142 | hnae_set_field(new_chain->int_gl_idx, HCLGE_INT_GL_IDX_M, |
143 | HCLGE_INT_GL_IDX_S, | |
ce50439a YL |
144 | req->msg[HCLGE_MBX_RING_NODE_VARIABLE_NUM * i + |
145 | HCLGE_MBX_RING_MAP_BASIC_MSG_NUM + 2]); | |
b385cfd8 | 146 | |
63d7e66f SM |
147 | cur_chain->next = new_chain; |
148 | cur_chain = new_chain; | |
149 | } | |
150 | ||
151 | return 0; | |
152 | err: | |
153 | hclge_free_vector_ring_chain(ring_chain); | |
154 | return -ENOMEM; | |
155 | } | |
156 | ||
157 | static int hclge_map_unmap_ring_to_vf_vector(struct hclge_vport *vport, bool en, | |
158 | struct hclge_mbx_vf_to_pf_cmd *req) | |
159 | { | |
160 | struct hnae3_ring_chain_node ring_chain; | |
161 | int vector_id = req->msg[1]; | |
162 | int ret; | |
163 | ||
164 | memset(&ring_chain, 0, sizeof(ring_chain)); | |
165 | ret = hclge_get_ring_chain_from_mbx(req, &ring_chain, vport); | |
166 | if (ret) | |
167 | return ret; | |
168 | ||
169 | ret = hclge_bind_ring_with_vector(vport, vector_id, en, &ring_chain); | |
170 | if (ret) | |
171 | return ret; | |
172 | ||
173 | hclge_free_vector_ring_chain(&ring_chain); | |
174 | ||
175 | return 0; | |
176 | } | |
177 | ||
0cdbdd3e SM |
178 | static int hclge_set_vf_promisc_mode(struct hclge_vport *vport, |
179 | struct hclge_mbx_vf_to_pf_cmd *req) | |
180 | { | |
181 | bool en = req->msg[1] ? true : false; | |
182 | struct hclge_promisc_param param; | |
183 | ||
184 | /* always enable broadcast promisc bit */ | |
185 | hclge_promisc_param_init(¶m, en, en, true, vport->vport_id); | |
186 | return hclge_cmd_set_promisc_mode(vport->back, ¶m); | |
187 | } | |
188 | ||
189 | static int hclge_set_vf_uc_mac_addr(struct hclge_vport *vport, | |
190 | struct hclge_mbx_vf_to_pf_cmd *mbx_req, | |
191 | bool gen_resp) | |
192 | { | |
193 | const u8 *mac_addr = (const u8 *)(&mbx_req->msg[2]); | |
194 | struct hclge_dev *hdev = vport->back; | |
195 | int status; | |
196 | ||
197 | if (mbx_req->msg[1] == HCLGE_MBX_MAC_VLAN_UC_MODIFY) { | |
198 | const u8 *old_addr = (const u8 *)(&mbx_req->msg[8]); | |
199 | ||
200 | hclge_rm_uc_addr_common(vport, old_addr); | |
201 | status = hclge_add_uc_addr_common(vport, mac_addr); | |
3cbf5e2d FL |
202 | if (status) |
203 | hclge_add_uc_addr_common(vport, old_addr); | |
0cdbdd3e SM |
204 | } else if (mbx_req->msg[1] == HCLGE_MBX_MAC_VLAN_UC_ADD) { |
205 | status = hclge_add_uc_addr_common(vport, mac_addr); | |
206 | } else if (mbx_req->msg[1] == HCLGE_MBX_MAC_VLAN_UC_REMOVE) { | |
207 | status = hclge_rm_uc_addr_common(vport, mac_addr); | |
208 | } else { | |
209 | dev_err(&hdev->pdev->dev, | |
210 | "failed to set unicast mac addr, unknown subcode %d\n", | |
211 | mbx_req->msg[1]); | |
212 | return -EIO; | |
213 | } | |
214 | ||
215 | if (gen_resp) | |
216 | hclge_gen_resp_to_vf(vport, mbx_req, status, NULL, 0); | |
217 | ||
218 | return 0; | |
219 | } | |
220 | ||
221 | static int hclge_set_vf_mc_mac_addr(struct hclge_vport *vport, | |
222 | struct hclge_mbx_vf_to_pf_cmd *mbx_req, | |
223 | bool gen_resp) | |
224 | { | |
225 | const u8 *mac_addr = (const u8 *)(&mbx_req->msg[2]); | |
226 | struct hclge_dev *hdev = vport->back; | |
227 | int status; | |
228 | ||
229 | if (mbx_req->msg[1] == HCLGE_MBX_MAC_VLAN_MC_ADD) { | |
230 | status = hclge_add_mc_addr_common(vport, mac_addr); | |
231 | } else if (mbx_req->msg[1] == HCLGE_MBX_MAC_VLAN_MC_REMOVE) { | |
232 | status = hclge_rm_mc_addr_common(vport, mac_addr); | |
233 | } else if (mbx_req->msg[1] == HCLGE_MBX_MAC_VLAN_MC_FUNC_MTA_ENABLE) { | |
234 | u8 func_id = vport->vport_id; | |
235 | bool enable = mbx_req->msg[2]; | |
236 | ||
237 | status = hclge_cfg_func_mta_filter(hdev, func_id, enable); | |
238 | } else { | |
239 | dev_err(&hdev->pdev->dev, | |
240 | "failed to set mcast mac addr, unknown subcode %d\n", | |
241 | mbx_req->msg[1]); | |
242 | return -EIO; | |
243 | } | |
244 | ||
245 | if (gen_resp) | |
246 | hclge_gen_resp_to_vf(vport, mbx_req, status, NULL, 0); | |
247 | ||
248 | return 0; | |
249 | } | |
250 | ||
251 | static int hclge_set_vf_vlan_cfg(struct hclge_vport *vport, | |
252 | struct hclge_mbx_vf_to_pf_cmd *mbx_req, | |
253 | bool gen_resp) | |
254 | { | |
255 | struct hclge_dev *hdev = vport->back; | |
256 | int status = 0; | |
257 | ||
258 | if (mbx_req->msg[1] == HCLGE_MBX_VLAN_FILTER) { | |
259 | u16 vlan, proto; | |
260 | bool is_kill; | |
261 | ||
262 | is_kill = !!mbx_req->msg[2]; | |
263 | memcpy(&vlan, &mbx_req->msg[3], sizeof(vlan)); | |
264 | memcpy(&proto, &mbx_req->msg[5], sizeof(proto)); | |
265 | status = hclge_set_vf_vlan_common(hdev, vport->vport_id, | |
266 | is_kill, vlan, 0, | |
267 | cpu_to_be16(proto)); | |
268 | } | |
269 | ||
270 | if (gen_resp) | |
271 | status = hclge_gen_resp_to_vf(vport, mbx_req, status, NULL, 0); | |
272 | ||
273 | return status; | |
274 | } | |
275 | ||
276 | static int hclge_get_vf_tcinfo(struct hclge_vport *vport, | |
277 | struct hclge_mbx_vf_to_pf_cmd *mbx_req, | |
278 | bool gen_resp) | |
279 | { | |
280 | struct hclge_dev *hdev = vport->back; | |
281 | int ret; | |
282 | ||
283 | ret = hclge_gen_resp_to_vf(vport, mbx_req, 0, &hdev->hw_tc_map, | |
284 | sizeof(u8)); | |
285 | ||
286 | return ret; | |
287 | } | |
288 | ||
289 | static int hclge_get_vf_queue_info(struct hclge_vport *vport, | |
290 | struct hclge_mbx_vf_to_pf_cmd *mbx_req, | |
291 | bool gen_resp) | |
292 | { | |
293 | #define HCLGE_TQPS_RSS_INFO_LEN 8 | |
294 | u8 resp_data[HCLGE_TQPS_RSS_INFO_LEN]; | |
295 | struct hclge_dev *hdev = vport->back; | |
296 | ||
297 | /* get the queue related info */ | |
298 | memcpy(&resp_data[0], &vport->alloc_tqps, sizeof(u16)); | |
24d74360 | 299 | memcpy(&resp_data[2], &vport->nic.kinfo.rss_size, sizeof(u16)); |
0cdbdd3e SM |
300 | memcpy(&resp_data[4], &hdev->num_desc, sizeof(u16)); |
301 | memcpy(&resp_data[6], &hdev->rx_buf_len, sizeof(u16)); | |
302 | ||
303 | return hclge_gen_resp_to_vf(vport, mbx_req, 0, resp_data, | |
304 | HCLGE_TQPS_RSS_INFO_LEN); | |
305 | } | |
306 | ||
307 | static int hclge_get_link_info(struct hclge_vport *vport, | |
308 | struct hclge_mbx_vf_to_pf_cmd *mbx_req) | |
309 | { | |
310 | struct hclge_dev *hdev = vport->back; | |
311 | u16 link_status; | |
312 | u8 msg_data[2]; | |
313 | u8 dest_vfid; | |
314 | ||
315 | /* mac.link can only be 0 or 1 */ | |
316 | link_status = (u16)hdev->hw.mac.link; | |
317 | memcpy(&msg_data[0], &link_status, sizeof(u16)); | |
318 | dest_vfid = mbx_req->mbx_src_vfid; | |
319 | ||
320 | /* send this requested info to VF */ | |
321 | return hclge_send_mbx_msg(vport, msg_data, sizeof(u8), | |
322 | HCLGE_MBX_LINK_STAT_CHANGE, dest_vfid); | |
323 | } | |
324 | ||
d3ea7fc4 PL |
325 | static void hclge_mbx_reset_vf_queue(struct hclge_vport *vport, |
326 | struct hclge_mbx_vf_to_pf_cmd *mbx_req) | |
63d7e66f SM |
327 | { |
328 | u16 queue_id; | |
329 | ||
330 | memcpy(&queue_id, &mbx_req->msg[2], sizeof(queue_id)); | |
331 | ||
d3ea7fc4 PL |
332 | hclge_reset_vf_queue(vport, queue_id); |
333 | ||
334 | /* send response msg to VF after queue reset complete*/ | |
335 | hclge_gen_resp_to_vf(vport, mbx_req, 0, NULL, 0); | |
63d7e66f SM |
336 | } |
337 | ||
0cdbdd3e SM |
338 | void hclge_mbx_handler(struct hclge_dev *hdev) |
339 | { | |
340 | struct hclge_cmq_ring *crq = &hdev->hw.cmq.crq; | |
341 | struct hclge_mbx_vf_to_pf_cmd *req; | |
342 | struct hclge_vport *vport; | |
343 | struct hclge_desc *desc; | |
6b910732 | 344 | int ret, flag; |
0cdbdd3e | 345 | |
6b910732 | 346 | flag = le16_to_cpu(crq->desc[crq->next_to_use].flag); |
0cdbdd3e | 347 | /* handle all the mailbox requests in the queue */ |
6b910732 | 348 | while (hnae_get_bit(flag, HCLGE_CMDQ_RX_OUTVLD_B)) { |
0cdbdd3e SM |
349 | desc = &crq->desc[crq->next_to_use]; |
350 | req = (struct hclge_mbx_vf_to_pf_cmd *)desc->data; | |
351 | ||
352 | vport = &hdev->vport[req->mbx_src_vfid]; | |
353 | ||
354 | switch (req->msg[0]) { | |
63d7e66f SM |
355 | case HCLGE_MBX_MAP_RING_TO_VECTOR: |
356 | ret = hclge_map_unmap_ring_to_vf_vector(vport, true, | |
357 | req); | |
358 | break; | |
359 | case HCLGE_MBX_UNMAP_RING_TO_VECTOR: | |
360 | ret = hclge_map_unmap_ring_to_vf_vector(vport, false, | |
361 | req); | |
362 | break; | |
0cdbdd3e SM |
363 | case HCLGE_MBX_SET_PROMISC_MODE: |
364 | ret = hclge_set_vf_promisc_mode(vport, req); | |
365 | if (ret) | |
366 | dev_err(&hdev->pdev->dev, | |
367 | "PF fail(%d) to set VF promisc mode\n", | |
368 | ret); | |
369 | break; | |
370 | case HCLGE_MBX_SET_UNICAST: | |
5a955cd2 | 371 | ret = hclge_set_vf_uc_mac_addr(vport, req, true); |
0cdbdd3e SM |
372 | if (ret) |
373 | dev_err(&hdev->pdev->dev, | |
374 | "PF fail(%d) to set VF UC MAC Addr\n", | |
375 | ret); | |
376 | break; | |
377 | case HCLGE_MBX_SET_MULTICAST: | |
378 | ret = hclge_set_vf_mc_mac_addr(vport, req, false); | |
379 | if (ret) | |
380 | dev_err(&hdev->pdev->dev, | |
381 | "PF fail(%d) to set VF MC MAC Addr\n", | |
382 | ret); | |
383 | break; | |
384 | case HCLGE_MBX_SET_VLAN: | |
385 | ret = hclge_set_vf_vlan_cfg(vport, req, false); | |
386 | if (ret) | |
387 | dev_err(&hdev->pdev->dev, | |
388 | "PF failed(%d) to config VF's VLAN\n", | |
389 | ret); | |
390 | break; | |
391 | case HCLGE_MBX_GET_QINFO: | |
392 | ret = hclge_get_vf_queue_info(vport, req, true); | |
393 | if (ret) | |
394 | dev_err(&hdev->pdev->dev, | |
395 | "PF failed(%d) to get Q info for VF\n", | |
396 | ret); | |
397 | break; | |
398 | case HCLGE_MBX_GET_TCINFO: | |
399 | ret = hclge_get_vf_tcinfo(vport, req, true); | |
400 | if (ret) | |
401 | dev_err(&hdev->pdev->dev, | |
402 | "PF failed(%d) to get TC info for VF\n", | |
403 | ret); | |
404 | break; | |
405 | case HCLGE_MBX_GET_LINK_STATUS: | |
406 | ret = hclge_get_link_info(vport, req); | |
407 | if (ret) | |
408 | dev_err(&hdev->pdev->dev, | |
409 | "PF fail(%d) to get link stat for VF\n", | |
410 | ret); | |
411 | break; | |
63d7e66f | 412 | case HCLGE_MBX_QUEUE_RESET: |
d3ea7fc4 | 413 | hclge_mbx_reset_vf_queue(vport, req); |
63d7e66f | 414 | break; |
0cdbdd3e SM |
415 | default: |
416 | dev_err(&hdev->pdev->dev, | |
417 | "un-supported mailbox message, code = %d\n", | |
418 | req->msg[0]); | |
419 | break; | |
420 | } | |
eae226f2 | 421 | crq->desc[crq->next_to_use].flag = 0; |
0cdbdd3e | 422 | hclge_mbx_ring_ptr_move_crq(crq); |
6b910732 | 423 | flag = le16_to_cpu(crq->desc[crq->next_to_use].flag); |
0cdbdd3e SM |
424 | } |
425 | ||
426 | /* Write back CMDQ_RQ header pointer, M7 need this pointer */ | |
427 | hclge_write_dev(&hdev->hw, HCLGE_NIC_CRQ_HEAD_REG, crq->next_to_use); | |
428 | } |