net: qed: convert to SPDX License Identifiers
[linux-2.6-microblaze.git] / drivers / net / ethernet / qlogic / qed / qed_fcoe.c
1 // SPDX-License-Identifier: (GPL-2.0-only OR BSD-3-Clause)
2 /* QLogic qed NIC Driver
3  * Copyright (c) 2015-2017  QLogic Corporation
4  */
5
6 #include <linux/types.h>
7 #include <asm/byteorder.h>
8 #include <asm/param.h>
9 #include <linux/delay.h>
10 #include <linux/dma-mapping.h>
11 #include <linux/interrupt.h>
12 #include <linux/kernel.h>
13 #include <linux/log2.h>
14 #include <linux/module.h>
15 #include <linux/pci.h>
16 #include <linux/slab.h>
17 #include <linux/stddef.h>
18 #include <linux/string.h>
19 #include <linux/workqueue.h>
20 #include <linux/errno.h>
21 #include <linux/list.h>
22 #include <linux/spinlock.h>
23 #define __PREVENT_DUMP_MEM_ARR__
24 #define __PREVENT_PXP_GLOBAL_WIN__
25 #include "qed.h"
26 #include "qed_cxt.h"
27 #include "qed_dev_api.h"
28 #include "qed_fcoe.h"
29 #include "qed_hsi.h"
30 #include "qed_hw.h"
31 #include "qed_int.h"
32 #include "qed_ll2.h"
33 #include "qed_mcp.h"
34 #include "qed_reg_addr.h"
35 #include "qed_sp.h"
36 #include "qed_sriov.h"
37 #include <linux/qed/qed_fcoe_if.h>
38
39 struct qed_fcoe_conn {
40         struct list_head list_entry;
41         bool free_on_delete;
42
43         u16 conn_id;
44         u32 icid;
45         u32 fw_cid;
46         u8 layer_code;
47
48         dma_addr_t sq_pbl_addr;
49         dma_addr_t sq_curr_page_addr;
50         dma_addr_t sq_next_page_addr;
51         dma_addr_t xferq_pbl_addr;
52         void *xferq_pbl_addr_virt_addr;
53         dma_addr_t xferq_addr[4];
54         void *xferq_addr_virt_addr[4];
55         dma_addr_t confq_pbl_addr;
56         void *confq_pbl_addr_virt_addr;
57         dma_addr_t confq_addr[2];
58         void *confq_addr_virt_addr[2];
59
60         dma_addr_t terminate_params;
61
62         u16 dst_mac_addr_lo;
63         u16 dst_mac_addr_mid;
64         u16 dst_mac_addr_hi;
65         u16 src_mac_addr_lo;
66         u16 src_mac_addr_mid;
67         u16 src_mac_addr_hi;
68
69         u16 tx_max_fc_pay_len;
70         u16 e_d_tov_timer_val;
71         u16 rec_tov_timer_val;
72         u16 rx_max_fc_pay_len;
73         u16 vlan_tag;
74         u16 physical_q0;
75
76         struct fc_addr_nw s_id;
77         u8 max_conc_seqs_c3;
78         struct fc_addr_nw d_id;
79         u8 flags;
80         u8 def_q_idx;
81 };
82
83 static int
84 qed_sp_fcoe_func_start(struct qed_hwfn *p_hwfn,
85                        enum spq_mode comp_mode,
86                        struct qed_spq_comp_cb *p_comp_addr)
87 {
88         struct qed_fcoe_pf_params *fcoe_pf_params = NULL;
89         struct fcoe_init_ramrod_params *p_ramrod = NULL;
90         struct fcoe_init_func_ramrod_data *p_data;
91         struct e4_fcoe_conn_context *p_cxt = NULL;
92         struct qed_spq_entry *p_ent = NULL;
93         struct qed_sp_init_data init_data;
94         struct qed_cxt_info cxt_info;
95         u32 dummy_cid;
96         int rc = 0;
97         u16 tmp;
98         u8 i;
99
100         /* Get SPQ entry */
101         memset(&init_data, 0, sizeof(init_data));
102         init_data.cid = qed_spq_get_cid(p_hwfn);
103         init_data.opaque_fid = p_hwfn->hw_info.opaque_fid;
104         init_data.comp_mode = comp_mode;
105         init_data.p_comp_data = p_comp_addr;
106
107         rc = qed_sp_init_request(p_hwfn, &p_ent,
108                                  FCOE_RAMROD_CMD_ID_INIT_FUNC,
109                                  PROTOCOLID_FCOE, &init_data);
110         if (rc)
111                 return rc;
112
113         p_ramrod = &p_ent->ramrod.fcoe_init;
114         p_data = &p_ramrod->init_ramrod_data;
115         fcoe_pf_params = &p_hwfn->pf_params.fcoe_pf_params;
116
117         /* Sanity */
118         if (fcoe_pf_params->num_cqs > p_hwfn->hw_info.feat_num[QED_FCOE_CQ]) {
119                 DP_ERR(p_hwfn,
120                        "Cannot satisfy CQ amount. CQs requested %d, CQs available %d. Aborting function start\n",
121                        fcoe_pf_params->num_cqs,
122                        p_hwfn->hw_info.feat_num[QED_FCOE_CQ]);
123                 rc = -EINVAL;
124                 goto err;
125         }
126
127         p_data->mtu = cpu_to_le16(fcoe_pf_params->mtu);
128         tmp = cpu_to_le16(fcoe_pf_params->sq_num_pbl_pages);
129         p_data->sq_num_pages_in_pbl = tmp;
130
131         rc = qed_cxt_acquire_cid(p_hwfn, PROTOCOLID_FCOE, &dummy_cid);
132         if (rc)
133                 goto err;
134
135         cxt_info.iid = dummy_cid;
136         rc = qed_cxt_get_cid_info(p_hwfn, &cxt_info);
137         if (rc) {
138                 DP_NOTICE(p_hwfn, "Cannot find context info for dummy cid=%d\n",
139                           dummy_cid);
140                 goto err;
141         }
142         p_cxt = cxt_info.p_cxt;
143         memset(p_cxt, 0, sizeof(*p_cxt));
144
145         SET_FIELD(p_cxt->tstorm_ag_context.flags3,
146                   E4_TSTORM_FCOE_CONN_AG_CTX_DUMMY_TIMER_CF_EN, 1);
147
148         fcoe_pf_params->dummy_icid = (u16)dummy_cid;
149
150         tmp = cpu_to_le16(fcoe_pf_params->num_tasks);
151         p_data->func_params.num_tasks = tmp;
152         p_data->func_params.log_page_size = fcoe_pf_params->log_page_size;
153         p_data->func_params.debug_mode = fcoe_pf_params->debug_mode;
154
155         DMA_REGPAIR_LE(p_data->q_params.glbl_q_params_addr,
156                        fcoe_pf_params->glbl_q_params_addr);
157
158         tmp = cpu_to_le16(fcoe_pf_params->cq_num_entries);
159         p_data->q_params.cq_num_entries = tmp;
160
161         tmp = cpu_to_le16(fcoe_pf_params->cmdq_num_entries);
162         p_data->q_params.cmdq_num_entries = tmp;
163
164         tmp = fcoe_pf_params->num_cqs;
165         p_data->q_params.num_queues = (u8)tmp;
166
167         tmp = (u16)p_hwfn->hw_info.resc_start[QED_CMDQS_CQS];
168         p_data->q_params.queue_relative_offset = (u8)tmp;
169
170         for (i = 0; i < fcoe_pf_params->num_cqs; i++) {
171                 u16 igu_sb_id;
172
173                 igu_sb_id = qed_get_igu_sb_id(p_hwfn, i);
174                 tmp = cpu_to_le16(igu_sb_id);
175                 p_data->q_params.cq_cmdq_sb_num_arr[i] = tmp;
176         }
177
178         p_data->q_params.cq_sb_pi = fcoe_pf_params->gl_rq_pi;
179         p_data->q_params.cmdq_sb_pi = fcoe_pf_params->gl_cmd_pi;
180
181         p_data->q_params.bdq_resource_id = (u8)RESC_START(p_hwfn, QED_BDQ);
182
183         DMA_REGPAIR_LE(p_data->q_params.bdq_pbl_base_address[BDQ_ID_RQ],
184                        fcoe_pf_params->bdq_pbl_base_addr[BDQ_ID_RQ]);
185         p_data->q_params.bdq_pbl_num_entries[BDQ_ID_RQ] =
186             fcoe_pf_params->bdq_pbl_num_entries[BDQ_ID_RQ];
187         tmp = fcoe_pf_params->bdq_xoff_threshold[BDQ_ID_RQ];
188         p_data->q_params.bdq_xoff_threshold[BDQ_ID_RQ] = cpu_to_le16(tmp);
189         tmp = fcoe_pf_params->bdq_xon_threshold[BDQ_ID_RQ];
190         p_data->q_params.bdq_xon_threshold[BDQ_ID_RQ] = cpu_to_le16(tmp);
191
192         DMA_REGPAIR_LE(p_data->q_params.bdq_pbl_base_address[BDQ_ID_IMM_DATA],
193                        fcoe_pf_params->bdq_pbl_base_addr[BDQ_ID_IMM_DATA]);
194         p_data->q_params.bdq_pbl_num_entries[BDQ_ID_IMM_DATA] =
195             fcoe_pf_params->bdq_pbl_num_entries[BDQ_ID_IMM_DATA];
196         tmp = fcoe_pf_params->bdq_xoff_threshold[BDQ_ID_IMM_DATA];
197         p_data->q_params.bdq_xoff_threshold[BDQ_ID_IMM_DATA] = cpu_to_le16(tmp);
198         tmp = fcoe_pf_params->bdq_xon_threshold[BDQ_ID_IMM_DATA];
199         p_data->q_params.bdq_xon_threshold[BDQ_ID_IMM_DATA] = cpu_to_le16(tmp);
200         tmp = fcoe_pf_params->rq_buffer_size;
201         p_data->q_params.rq_buffer_size = cpu_to_le16(tmp);
202
203         if (fcoe_pf_params->is_target) {
204                 SET_FIELD(p_data->q_params.q_validity,
205                           SCSI_INIT_FUNC_QUEUES_RQ_VALID, 1);
206                 if (p_data->q_params.bdq_pbl_num_entries[BDQ_ID_IMM_DATA])
207                         SET_FIELD(p_data->q_params.q_validity,
208                                   SCSI_INIT_FUNC_QUEUES_IMM_DATA_VALID, 1);
209                 SET_FIELD(p_data->q_params.q_validity,
210                           SCSI_INIT_FUNC_QUEUES_CMD_VALID, 1);
211         } else {
212                 SET_FIELD(p_data->q_params.q_validity,
213                           SCSI_INIT_FUNC_QUEUES_RQ_VALID, 1);
214         }
215
216         rc = qed_spq_post(p_hwfn, p_ent, NULL);
217
218         return rc;
219
220 err:
221         qed_sp_destroy_request(p_hwfn, p_ent);
222         return rc;
223 }
224
225 static int
226 qed_sp_fcoe_conn_offload(struct qed_hwfn *p_hwfn,
227                          struct qed_fcoe_conn *p_conn,
228                          enum spq_mode comp_mode,
229                          struct qed_spq_comp_cb *p_comp_addr)
230 {
231         struct fcoe_conn_offload_ramrod_params *p_ramrod = NULL;
232         struct fcoe_conn_offload_ramrod_data *p_data;
233         struct qed_spq_entry *p_ent = NULL;
234         struct qed_sp_init_data init_data;
235         u16 physical_q0, tmp;
236         int rc;
237
238         /* Get SPQ entry */
239         memset(&init_data, 0, sizeof(init_data));
240         init_data.cid = p_conn->icid;
241         init_data.opaque_fid = p_hwfn->hw_info.opaque_fid;
242         init_data.comp_mode = comp_mode;
243         init_data.p_comp_data = p_comp_addr;
244
245         rc = qed_sp_init_request(p_hwfn, &p_ent,
246                                  FCOE_RAMROD_CMD_ID_OFFLOAD_CONN,
247                                  PROTOCOLID_FCOE, &init_data);
248         if (rc)
249                 return rc;
250
251         p_ramrod = &p_ent->ramrod.fcoe_conn_ofld;
252         p_data = &p_ramrod->offload_ramrod_data;
253
254         /* Transmission PQ is the first of the PF */
255         physical_q0 = qed_get_cm_pq_idx(p_hwfn, PQ_FLAGS_OFLD);
256         p_conn->physical_q0 = cpu_to_le16(physical_q0);
257         p_data->physical_q0 = cpu_to_le16(physical_q0);
258
259         p_data->conn_id = cpu_to_le16(p_conn->conn_id);
260         DMA_REGPAIR_LE(p_data->sq_pbl_addr, p_conn->sq_pbl_addr);
261         DMA_REGPAIR_LE(p_data->sq_curr_page_addr, p_conn->sq_curr_page_addr);
262         DMA_REGPAIR_LE(p_data->sq_next_page_addr, p_conn->sq_next_page_addr);
263         DMA_REGPAIR_LE(p_data->xferq_pbl_addr, p_conn->xferq_pbl_addr);
264         DMA_REGPAIR_LE(p_data->xferq_curr_page_addr, p_conn->xferq_addr[0]);
265         DMA_REGPAIR_LE(p_data->xferq_next_page_addr, p_conn->xferq_addr[1]);
266
267         DMA_REGPAIR_LE(p_data->respq_pbl_addr, p_conn->confq_pbl_addr);
268         DMA_REGPAIR_LE(p_data->respq_curr_page_addr, p_conn->confq_addr[0]);
269         DMA_REGPAIR_LE(p_data->respq_next_page_addr, p_conn->confq_addr[1]);
270
271         p_data->dst_mac_addr_lo = cpu_to_le16(p_conn->dst_mac_addr_lo);
272         p_data->dst_mac_addr_mid = cpu_to_le16(p_conn->dst_mac_addr_mid);
273         p_data->dst_mac_addr_hi = cpu_to_le16(p_conn->dst_mac_addr_hi);
274         p_data->src_mac_addr_lo = cpu_to_le16(p_conn->src_mac_addr_lo);
275         p_data->src_mac_addr_mid = cpu_to_le16(p_conn->src_mac_addr_mid);
276         p_data->src_mac_addr_hi = cpu_to_le16(p_conn->src_mac_addr_hi);
277
278         tmp = cpu_to_le16(p_conn->tx_max_fc_pay_len);
279         p_data->tx_max_fc_pay_len = tmp;
280         tmp = cpu_to_le16(p_conn->e_d_tov_timer_val);
281         p_data->e_d_tov_timer_val = tmp;
282         tmp = cpu_to_le16(p_conn->rec_tov_timer_val);
283         p_data->rec_rr_tov_timer_val = tmp;
284         tmp = cpu_to_le16(p_conn->rx_max_fc_pay_len);
285         p_data->rx_max_fc_pay_len = tmp;
286
287         p_data->vlan_tag = cpu_to_le16(p_conn->vlan_tag);
288         p_data->s_id.addr_hi = p_conn->s_id.addr_hi;
289         p_data->s_id.addr_mid = p_conn->s_id.addr_mid;
290         p_data->s_id.addr_lo = p_conn->s_id.addr_lo;
291         p_data->max_conc_seqs_c3 = p_conn->max_conc_seqs_c3;
292         p_data->d_id.addr_hi = p_conn->d_id.addr_hi;
293         p_data->d_id.addr_mid = p_conn->d_id.addr_mid;
294         p_data->d_id.addr_lo = p_conn->d_id.addr_lo;
295         p_data->flags = p_conn->flags;
296         if (test_bit(QED_MF_UFP_SPECIFIC, &p_hwfn->cdev->mf_bits))
297                 SET_FIELD(p_data->flags,
298                           FCOE_CONN_OFFLOAD_RAMROD_DATA_B_SINGLE_VLAN, 1);
299         p_data->def_q_idx = p_conn->def_q_idx;
300
301         return qed_spq_post(p_hwfn, p_ent, NULL);
302 }
303
304 static int
305 qed_sp_fcoe_conn_destroy(struct qed_hwfn *p_hwfn,
306                          struct qed_fcoe_conn *p_conn,
307                          enum spq_mode comp_mode,
308                          struct qed_spq_comp_cb *p_comp_addr)
309 {
310         struct fcoe_conn_terminate_ramrod_params *p_ramrod = NULL;
311         struct qed_spq_entry *p_ent = NULL;
312         struct qed_sp_init_data init_data;
313         int rc = 0;
314
315         /* Get SPQ entry */
316         memset(&init_data, 0, sizeof(init_data));
317         init_data.cid = p_conn->icid;
318         init_data.opaque_fid = p_hwfn->hw_info.opaque_fid;
319         init_data.comp_mode = comp_mode;
320         init_data.p_comp_data = p_comp_addr;
321
322         rc = qed_sp_init_request(p_hwfn, &p_ent,
323                                  FCOE_RAMROD_CMD_ID_TERMINATE_CONN,
324                                  PROTOCOLID_FCOE, &init_data);
325         if (rc)
326                 return rc;
327
328         p_ramrod = &p_ent->ramrod.fcoe_conn_terminate;
329         DMA_REGPAIR_LE(p_ramrod->terminate_ramrod_data.terminate_params_addr,
330                        p_conn->terminate_params);
331
332         return qed_spq_post(p_hwfn, p_ent, NULL);
333 }
334
335 static int
336 qed_sp_fcoe_func_stop(struct qed_hwfn *p_hwfn,
337                       struct qed_ptt *p_ptt,
338                       enum spq_mode comp_mode,
339                       struct qed_spq_comp_cb *p_comp_addr)
340 {
341         struct qed_spq_entry *p_ent = NULL;
342         struct qed_sp_init_data init_data;
343         u32 active_segs = 0;
344         int rc = 0;
345
346         /* Get SPQ entry */
347         memset(&init_data, 0, sizeof(init_data));
348         init_data.cid = p_hwfn->pf_params.fcoe_pf_params.dummy_icid;
349         init_data.opaque_fid = p_hwfn->hw_info.opaque_fid;
350         init_data.comp_mode = comp_mode;
351         init_data.p_comp_data = p_comp_addr;
352
353         rc = qed_sp_init_request(p_hwfn, &p_ent,
354                                  FCOE_RAMROD_CMD_ID_DESTROY_FUNC,
355                                  PROTOCOLID_FCOE, &init_data);
356         if (rc)
357                 return rc;
358
359         active_segs = qed_rd(p_hwfn, p_ptt, TM_REG_PF_ENABLE_TASK);
360         active_segs &= ~BIT(QED_CXT_FCOE_TID_SEG);
361         qed_wr(p_hwfn, p_ptt, TM_REG_PF_ENABLE_TASK, active_segs);
362
363         return qed_spq_post(p_hwfn, p_ent, NULL);
364 }
365
366 static int
367 qed_fcoe_allocate_connection(struct qed_hwfn *p_hwfn,
368                              struct qed_fcoe_conn **p_out_conn)
369 {
370         struct qed_fcoe_conn *p_conn = NULL;
371         void *p_addr;
372         u32 i;
373
374         spin_lock_bh(&p_hwfn->p_fcoe_info->lock);
375         if (!list_empty(&p_hwfn->p_fcoe_info->free_list))
376                 p_conn =
377                     list_first_entry(&p_hwfn->p_fcoe_info->free_list,
378                                      struct qed_fcoe_conn, list_entry);
379         if (p_conn) {
380                 list_del(&p_conn->list_entry);
381                 spin_unlock_bh(&p_hwfn->p_fcoe_info->lock);
382                 *p_out_conn = p_conn;
383                 return 0;
384         }
385         spin_unlock_bh(&p_hwfn->p_fcoe_info->lock);
386
387         p_conn = kzalloc(sizeof(*p_conn), GFP_KERNEL);
388         if (!p_conn)
389                 return -ENOMEM;
390
391         p_addr = dma_alloc_coherent(&p_hwfn->cdev->pdev->dev,
392                                     QED_CHAIN_PAGE_SIZE,
393                                     &p_conn->xferq_pbl_addr, GFP_KERNEL);
394         if (!p_addr)
395                 goto nomem_pbl_xferq;
396         p_conn->xferq_pbl_addr_virt_addr = p_addr;
397
398         for (i = 0; i < ARRAY_SIZE(p_conn->xferq_addr); i++) {
399                 p_addr = dma_alloc_coherent(&p_hwfn->cdev->pdev->dev,
400                                             QED_CHAIN_PAGE_SIZE,
401                                             &p_conn->xferq_addr[i], GFP_KERNEL);
402                 if (!p_addr)
403                         goto nomem_xferq;
404                 p_conn->xferq_addr_virt_addr[i] = p_addr;
405
406                 p_addr = p_conn->xferq_pbl_addr_virt_addr;
407                 ((dma_addr_t *)p_addr)[i] = p_conn->xferq_addr[i];
408         }
409
410         p_addr = dma_alloc_coherent(&p_hwfn->cdev->pdev->dev,
411                                     QED_CHAIN_PAGE_SIZE,
412                                     &p_conn->confq_pbl_addr, GFP_KERNEL);
413         if (!p_addr)
414                 goto nomem_xferq;
415         p_conn->confq_pbl_addr_virt_addr = p_addr;
416
417         for (i = 0; i < ARRAY_SIZE(p_conn->confq_addr); i++) {
418                 p_addr = dma_alloc_coherent(&p_hwfn->cdev->pdev->dev,
419                                             QED_CHAIN_PAGE_SIZE,
420                                             &p_conn->confq_addr[i], GFP_KERNEL);
421                 if (!p_addr)
422                         goto nomem_confq;
423                 p_conn->confq_addr_virt_addr[i] = p_addr;
424
425                 p_addr = p_conn->confq_pbl_addr_virt_addr;
426                 ((dma_addr_t *)p_addr)[i] = p_conn->confq_addr[i];
427         }
428
429         p_conn->free_on_delete = true;
430         *p_out_conn = p_conn;
431         return 0;
432
433 nomem_confq:
434         dma_free_coherent(&p_hwfn->cdev->pdev->dev,
435                           QED_CHAIN_PAGE_SIZE,
436                           p_conn->confq_pbl_addr_virt_addr,
437                           p_conn->confq_pbl_addr);
438         for (i = 0; i < ARRAY_SIZE(p_conn->confq_addr); i++)
439                 if (p_conn->confq_addr_virt_addr[i])
440                         dma_free_coherent(&p_hwfn->cdev->pdev->dev,
441                                           QED_CHAIN_PAGE_SIZE,
442                                           p_conn->confq_addr_virt_addr[i],
443                                           p_conn->confq_addr[i]);
444 nomem_xferq:
445         dma_free_coherent(&p_hwfn->cdev->pdev->dev,
446                           QED_CHAIN_PAGE_SIZE,
447                           p_conn->xferq_pbl_addr_virt_addr,
448                           p_conn->xferq_pbl_addr);
449         for (i = 0; i < ARRAY_SIZE(p_conn->xferq_addr); i++)
450                 if (p_conn->xferq_addr_virt_addr[i])
451                         dma_free_coherent(&p_hwfn->cdev->pdev->dev,
452                                           QED_CHAIN_PAGE_SIZE,
453                                           p_conn->xferq_addr_virt_addr[i],
454                                           p_conn->xferq_addr[i]);
455 nomem_pbl_xferq:
456         kfree(p_conn);
457         return -ENOMEM;
458 }
459
460 static void qed_fcoe_free_connection(struct qed_hwfn *p_hwfn,
461                                      struct qed_fcoe_conn *p_conn)
462 {
463         u32 i;
464
465         if (!p_conn)
466                 return;
467
468         if (p_conn->confq_pbl_addr_virt_addr)
469                 dma_free_coherent(&p_hwfn->cdev->pdev->dev,
470                                   QED_CHAIN_PAGE_SIZE,
471                                   p_conn->confq_pbl_addr_virt_addr,
472                                   p_conn->confq_pbl_addr);
473
474         for (i = 0; i < ARRAY_SIZE(p_conn->confq_addr); i++) {
475                 if (!p_conn->confq_addr_virt_addr[i])
476                         continue;
477                 dma_free_coherent(&p_hwfn->cdev->pdev->dev,
478                                   QED_CHAIN_PAGE_SIZE,
479                                   p_conn->confq_addr_virt_addr[i],
480                                   p_conn->confq_addr[i]);
481         }
482
483         if (p_conn->xferq_pbl_addr_virt_addr)
484                 dma_free_coherent(&p_hwfn->cdev->pdev->dev,
485                                   QED_CHAIN_PAGE_SIZE,
486                                   p_conn->xferq_pbl_addr_virt_addr,
487                                   p_conn->xferq_pbl_addr);
488
489         for (i = 0; i < ARRAY_SIZE(p_conn->xferq_addr); i++) {
490                 if (!p_conn->xferq_addr_virt_addr[i])
491                         continue;
492                 dma_free_coherent(&p_hwfn->cdev->pdev->dev,
493                                   QED_CHAIN_PAGE_SIZE,
494                                   p_conn->xferq_addr_virt_addr[i],
495                                   p_conn->xferq_addr[i]);
496         }
497         kfree(p_conn);
498 }
499
500 static void __iomem *qed_fcoe_get_db_addr(struct qed_hwfn *p_hwfn, u32 cid)
501 {
502         return (u8 __iomem *)p_hwfn->doorbells +
503                qed_db_addr(cid, DQ_DEMS_LEGACY);
504 }
505
506 static void __iomem *qed_fcoe_get_primary_bdq_prod(struct qed_hwfn *p_hwfn,
507                                                    u8 bdq_id)
508 {
509         if (RESC_NUM(p_hwfn, QED_BDQ)) {
510                 return (u8 __iomem *)p_hwfn->regview +
511                        GTT_BAR0_MAP_REG_MSDM_RAM +
512                        MSTORM_SCSI_BDQ_EXT_PROD_OFFSET(RESC_START(p_hwfn,
513                                                                   QED_BDQ),
514                                                        bdq_id);
515         } else {
516                 DP_NOTICE(p_hwfn, "BDQ is not allocated!\n");
517                 return NULL;
518         }
519 }
520
521 static void __iomem *qed_fcoe_get_secondary_bdq_prod(struct qed_hwfn *p_hwfn,
522                                                      u8 bdq_id)
523 {
524         if (RESC_NUM(p_hwfn, QED_BDQ)) {
525                 return (u8 __iomem *)p_hwfn->regview +
526                        GTT_BAR0_MAP_REG_TSDM_RAM +
527                        TSTORM_SCSI_BDQ_EXT_PROD_OFFSET(RESC_START(p_hwfn,
528                                                                   QED_BDQ),
529                                                        bdq_id);
530         } else {
531                 DP_NOTICE(p_hwfn, "BDQ is not allocated!\n");
532                 return NULL;
533         }
534 }
535
536 int qed_fcoe_alloc(struct qed_hwfn *p_hwfn)
537 {
538         struct qed_fcoe_info *p_fcoe_info;
539
540         /* Allocate LL2's set struct */
541         p_fcoe_info = kzalloc(sizeof(*p_fcoe_info), GFP_KERNEL);
542         if (!p_fcoe_info) {
543                 DP_NOTICE(p_hwfn, "Failed to allocate qed_fcoe_info'\n");
544                 return -ENOMEM;
545         }
546         INIT_LIST_HEAD(&p_fcoe_info->free_list);
547
548         p_hwfn->p_fcoe_info = p_fcoe_info;
549         return 0;
550 }
551
552 void qed_fcoe_setup(struct qed_hwfn *p_hwfn)
553 {
554         struct e4_fcoe_task_context *p_task_ctx = NULL;
555         int rc;
556         u32 i;
557
558         spin_lock_init(&p_hwfn->p_fcoe_info->lock);
559         for (i = 0; i < p_hwfn->pf_params.fcoe_pf_params.num_tasks; i++) {
560                 rc = qed_cxt_get_task_ctx(p_hwfn, i,
561                                           QED_CTX_WORKING_MEM,
562                                           (void **)&p_task_ctx);
563                 if (rc)
564                         continue;
565
566                 memset(p_task_ctx, 0, sizeof(struct e4_fcoe_task_context));
567                 SET_FIELD(p_task_ctx->timer_context.logical_client_0,
568                           TIMERS_CONTEXT_VALIDLC0, 1);
569                 SET_FIELD(p_task_ctx->timer_context.logical_client_1,
570                           TIMERS_CONTEXT_VALIDLC1, 1);
571                 SET_FIELD(p_task_ctx->tstorm_ag_context.flags0,
572                           E4_TSTORM_FCOE_TASK_AG_CTX_CONNECTION_TYPE, 1);
573         }
574 }
575
576 void qed_fcoe_free(struct qed_hwfn *p_hwfn)
577 {
578         struct qed_fcoe_conn *p_conn = NULL;
579
580         if (!p_hwfn->p_fcoe_info)
581                 return;
582
583         while (!list_empty(&p_hwfn->p_fcoe_info->free_list)) {
584                 p_conn = list_first_entry(&p_hwfn->p_fcoe_info->free_list,
585                                           struct qed_fcoe_conn, list_entry);
586                 if (!p_conn)
587                         break;
588                 list_del(&p_conn->list_entry);
589                 qed_fcoe_free_connection(p_hwfn, p_conn);
590         }
591
592         kfree(p_hwfn->p_fcoe_info);
593         p_hwfn->p_fcoe_info = NULL;
594 }
595
596 static int
597 qed_fcoe_acquire_connection(struct qed_hwfn *p_hwfn,
598                             struct qed_fcoe_conn *p_in_conn,
599                             struct qed_fcoe_conn **p_out_conn)
600 {
601         struct qed_fcoe_conn *p_conn = NULL;
602         int rc = 0;
603         u32 icid;
604
605         spin_lock_bh(&p_hwfn->p_fcoe_info->lock);
606         rc = qed_cxt_acquire_cid(p_hwfn, PROTOCOLID_FCOE, &icid);
607         spin_unlock_bh(&p_hwfn->p_fcoe_info->lock);
608         if (rc)
609                 return rc;
610
611         /* Use input connection [if provided] or allocate a new one */
612         if (p_in_conn) {
613                 p_conn = p_in_conn;
614         } else {
615                 rc = qed_fcoe_allocate_connection(p_hwfn, &p_conn);
616                 if (rc) {
617                         spin_lock_bh(&p_hwfn->p_fcoe_info->lock);
618                         qed_cxt_release_cid(p_hwfn, icid);
619                         spin_unlock_bh(&p_hwfn->p_fcoe_info->lock);
620                         return rc;
621                 }
622         }
623
624         p_conn->icid = icid;
625         p_conn->fw_cid = (p_hwfn->hw_info.opaque_fid << 16) | icid;
626         *p_out_conn = p_conn;
627
628         return rc;
629 }
630
631 static void qed_fcoe_release_connection(struct qed_hwfn *p_hwfn,
632                                         struct qed_fcoe_conn *p_conn)
633 {
634         spin_lock_bh(&p_hwfn->p_fcoe_info->lock);
635         list_add_tail(&p_conn->list_entry, &p_hwfn->p_fcoe_info->free_list);
636         qed_cxt_release_cid(p_hwfn, p_conn->icid);
637         spin_unlock_bh(&p_hwfn->p_fcoe_info->lock);
638 }
639
640 static void _qed_fcoe_get_tstats(struct qed_hwfn *p_hwfn,
641                                  struct qed_ptt *p_ptt,
642                                  struct qed_fcoe_stats *p_stats)
643 {
644         struct fcoe_rx_stat tstats;
645         u32 tstats_addr;
646
647         memset(&tstats, 0, sizeof(tstats));
648         tstats_addr = BAR0_MAP_REG_TSDM_RAM +
649             TSTORM_FCOE_RX_STATS_OFFSET(p_hwfn->rel_pf_id);
650         qed_memcpy_from(p_hwfn, p_ptt, &tstats, tstats_addr, sizeof(tstats));
651
652         p_stats->fcoe_rx_byte_cnt = HILO_64_REGPAIR(tstats.fcoe_rx_byte_cnt);
653         p_stats->fcoe_rx_data_pkt_cnt =
654             HILO_64_REGPAIR(tstats.fcoe_rx_data_pkt_cnt);
655         p_stats->fcoe_rx_xfer_pkt_cnt =
656             HILO_64_REGPAIR(tstats.fcoe_rx_xfer_pkt_cnt);
657         p_stats->fcoe_rx_other_pkt_cnt =
658             HILO_64_REGPAIR(tstats.fcoe_rx_other_pkt_cnt);
659
660         p_stats->fcoe_silent_drop_pkt_cmdq_full_cnt =
661             le32_to_cpu(tstats.fcoe_silent_drop_pkt_cmdq_full_cnt);
662         p_stats->fcoe_silent_drop_pkt_rq_full_cnt =
663             le32_to_cpu(tstats.fcoe_silent_drop_pkt_rq_full_cnt);
664         p_stats->fcoe_silent_drop_pkt_crc_error_cnt =
665             le32_to_cpu(tstats.fcoe_silent_drop_pkt_crc_error_cnt);
666         p_stats->fcoe_silent_drop_pkt_task_invalid_cnt =
667             le32_to_cpu(tstats.fcoe_silent_drop_pkt_task_invalid_cnt);
668         p_stats->fcoe_silent_drop_total_pkt_cnt =
669             le32_to_cpu(tstats.fcoe_silent_drop_total_pkt_cnt);
670 }
671
672 static void _qed_fcoe_get_pstats(struct qed_hwfn *p_hwfn,
673                                  struct qed_ptt *p_ptt,
674                                  struct qed_fcoe_stats *p_stats)
675 {
676         struct fcoe_tx_stat pstats;
677         u32 pstats_addr;
678
679         memset(&pstats, 0, sizeof(pstats));
680         pstats_addr = BAR0_MAP_REG_PSDM_RAM +
681             PSTORM_FCOE_TX_STATS_OFFSET(p_hwfn->rel_pf_id);
682         qed_memcpy_from(p_hwfn, p_ptt, &pstats, pstats_addr, sizeof(pstats));
683
684         p_stats->fcoe_tx_byte_cnt = HILO_64_REGPAIR(pstats.fcoe_tx_byte_cnt);
685         p_stats->fcoe_tx_data_pkt_cnt =
686             HILO_64_REGPAIR(pstats.fcoe_tx_data_pkt_cnt);
687         p_stats->fcoe_tx_xfer_pkt_cnt =
688             HILO_64_REGPAIR(pstats.fcoe_tx_xfer_pkt_cnt);
689         p_stats->fcoe_tx_other_pkt_cnt =
690             HILO_64_REGPAIR(pstats.fcoe_tx_other_pkt_cnt);
691 }
692
693 static int qed_fcoe_get_stats(struct qed_hwfn *p_hwfn,
694                               struct qed_fcoe_stats *p_stats)
695 {
696         struct qed_ptt *p_ptt;
697
698         memset(p_stats, 0, sizeof(*p_stats));
699
700         p_ptt = qed_ptt_acquire(p_hwfn);
701
702         if (!p_ptt) {
703                 DP_ERR(p_hwfn, "Failed to acquire ptt\n");
704                 return -EINVAL;
705         }
706
707         _qed_fcoe_get_tstats(p_hwfn, p_ptt, p_stats);
708         _qed_fcoe_get_pstats(p_hwfn, p_ptt, p_stats);
709
710         qed_ptt_release(p_hwfn, p_ptt);
711
712         return 0;
713 }
714
715 struct qed_hash_fcoe_con {
716         struct hlist_node node;
717         struct qed_fcoe_conn *con;
718 };
719
720 static int qed_fill_fcoe_dev_info(struct qed_dev *cdev,
721                                   struct qed_dev_fcoe_info *info)
722 {
723         struct qed_hwfn *hwfn = QED_AFFIN_HWFN(cdev);
724         int rc;
725
726         memset(info, 0, sizeof(*info));
727         rc = qed_fill_dev_info(cdev, &info->common);
728
729         info->primary_dbq_rq_addr =
730             qed_fcoe_get_primary_bdq_prod(hwfn, BDQ_ID_RQ);
731         info->secondary_bdq_rq_addr =
732             qed_fcoe_get_secondary_bdq_prod(hwfn, BDQ_ID_RQ);
733
734         info->wwpn = hwfn->mcp_info->func_info.wwn_port;
735         info->wwnn = hwfn->mcp_info->func_info.wwn_node;
736
737         info->num_cqs = FEAT_NUM(hwfn, QED_FCOE_CQ);
738
739         return rc;
740 }
741
742 static void qed_register_fcoe_ops(struct qed_dev *cdev,
743                                   struct qed_fcoe_cb_ops *ops, void *cookie)
744 {
745         cdev->protocol_ops.fcoe = ops;
746         cdev->ops_cookie = cookie;
747 }
748
749 static struct qed_hash_fcoe_con *qed_fcoe_get_hash(struct qed_dev *cdev,
750                                                    u32 handle)
751 {
752         struct qed_hash_fcoe_con *hash_con = NULL;
753
754         if (!(cdev->flags & QED_FLAG_STORAGE_STARTED))
755                 return NULL;
756
757         hash_for_each_possible(cdev->connections, hash_con, node, handle) {
758                 if (hash_con->con->icid == handle)
759                         break;
760         }
761
762         if (!hash_con || (hash_con->con->icid != handle))
763                 return NULL;
764
765         return hash_con;
766 }
767
768 static int qed_fcoe_stop(struct qed_dev *cdev)
769 {
770         struct qed_ptt *p_ptt;
771         int rc;
772
773         if (!(cdev->flags & QED_FLAG_STORAGE_STARTED)) {
774                 DP_NOTICE(cdev, "fcoe already stopped\n");
775                 return 0;
776         }
777
778         if (!hash_empty(cdev->connections)) {
779                 DP_NOTICE(cdev,
780                           "Can't stop fcoe - not all connections were returned\n");
781                 return -EINVAL;
782         }
783
784         p_ptt = qed_ptt_acquire(QED_AFFIN_HWFN(cdev));
785         if (!p_ptt)
786                 return -EAGAIN;
787
788         /* Stop the fcoe */
789         rc = qed_sp_fcoe_func_stop(QED_AFFIN_HWFN(cdev), p_ptt,
790                                    QED_SPQ_MODE_EBLOCK, NULL);
791         cdev->flags &= ~QED_FLAG_STORAGE_STARTED;
792         qed_ptt_release(QED_AFFIN_HWFN(cdev), p_ptt);
793
794         return rc;
795 }
796
797 static int qed_fcoe_start(struct qed_dev *cdev, struct qed_fcoe_tid *tasks)
798 {
799         int rc;
800
801         if (cdev->flags & QED_FLAG_STORAGE_STARTED) {
802                 DP_NOTICE(cdev, "fcoe already started;\n");
803                 return 0;
804         }
805
806         rc = qed_sp_fcoe_func_start(QED_AFFIN_HWFN(cdev), QED_SPQ_MODE_EBLOCK,
807                                     NULL);
808         if (rc) {
809                 DP_NOTICE(cdev, "Failed to start fcoe\n");
810                 return rc;
811         }
812
813         cdev->flags |= QED_FLAG_STORAGE_STARTED;
814         hash_init(cdev->connections);
815
816         if (tasks) {
817                 struct qed_tid_mem *tid_info = kzalloc(sizeof(*tid_info),
818                                                        GFP_ATOMIC);
819
820                 if (!tid_info) {
821                         DP_NOTICE(cdev,
822                                   "Failed to allocate tasks information\n");
823                         qed_fcoe_stop(cdev);
824                         return -ENOMEM;
825                 }
826
827                 rc = qed_cxt_get_tid_mem_info(QED_AFFIN_HWFN(cdev), tid_info);
828                 if (rc) {
829                         DP_NOTICE(cdev, "Failed to gather task information\n");
830                         qed_fcoe_stop(cdev);
831                         kfree(tid_info);
832                         return rc;
833                 }
834
835                 /* Fill task information */
836                 tasks->size = tid_info->tid_size;
837                 tasks->num_tids_per_block = tid_info->num_tids_per_block;
838                 memcpy(tasks->blocks, tid_info->blocks,
839                        MAX_TID_BLOCKS_FCOE * sizeof(u8 *));
840
841                 kfree(tid_info);
842         }
843
844         return 0;
845 }
846
847 static int qed_fcoe_acquire_conn(struct qed_dev *cdev,
848                                  u32 *handle,
849                                  u32 *fw_cid, void __iomem **p_doorbell)
850 {
851         struct qed_hash_fcoe_con *hash_con;
852         int rc;
853
854         /* Allocate a hashed connection */
855         hash_con = kzalloc(sizeof(*hash_con), GFP_KERNEL);
856         if (!hash_con) {
857                 DP_NOTICE(cdev, "Failed to allocate hashed connection\n");
858                 return -ENOMEM;
859         }
860
861         /* Acquire the connection */
862         rc = qed_fcoe_acquire_connection(QED_AFFIN_HWFN(cdev), NULL,
863                                          &hash_con->con);
864         if (rc) {
865                 DP_NOTICE(cdev, "Failed to acquire Connection\n");
866                 kfree(hash_con);
867                 return rc;
868         }
869
870         /* Added the connection to hash table */
871         *handle = hash_con->con->icid;
872         *fw_cid = hash_con->con->fw_cid;
873         hash_add(cdev->connections, &hash_con->node, *handle);
874
875         if (p_doorbell)
876                 *p_doorbell = qed_fcoe_get_db_addr(QED_AFFIN_HWFN(cdev),
877                                                    *handle);
878
879         return 0;
880 }
881
882 static int qed_fcoe_release_conn(struct qed_dev *cdev, u32 handle)
883 {
884         struct qed_hash_fcoe_con *hash_con;
885
886         hash_con = qed_fcoe_get_hash(cdev, handle);
887         if (!hash_con) {
888                 DP_NOTICE(cdev, "Failed to find connection for handle %d\n",
889                           handle);
890                 return -EINVAL;
891         }
892
893         hlist_del(&hash_con->node);
894         qed_fcoe_release_connection(QED_AFFIN_HWFN(cdev), hash_con->con);
895         kfree(hash_con);
896
897         return 0;
898 }
899
900 static int qed_fcoe_offload_conn(struct qed_dev *cdev,
901                                  u32 handle,
902                                  struct qed_fcoe_params_offload *conn_info)
903 {
904         struct qed_hash_fcoe_con *hash_con;
905         struct qed_fcoe_conn *con;
906
907         hash_con = qed_fcoe_get_hash(cdev, handle);
908         if (!hash_con) {
909                 DP_NOTICE(cdev, "Failed to find connection for handle %d\n",
910                           handle);
911                 return -EINVAL;
912         }
913
914         /* Update the connection with information from the params */
915         con = hash_con->con;
916
917         con->sq_pbl_addr = conn_info->sq_pbl_addr;
918         con->sq_curr_page_addr = conn_info->sq_curr_page_addr;
919         con->sq_next_page_addr = conn_info->sq_next_page_addr;
920         con->tx_max_fc_pay_len = conn_info->tx_max_fc_pay_len;
921         con->e_d_tov_timer_val = conn_info->e_d_tov_timer_val;
922         con->rec_tov_timer_val = conn_info->rec_tov_timer_val;
923         con->rx_max_fc_pay_len = conn_info->rx_max_fc_pay_len;
924         con->vlan_tag = conn_info->vlan_tag;
925         con->max_conc_seqs_c3 = conn_info->max_conc_seqs_c3;
926         con->flags = conn_info->flags;
927         con->def_q_idx = conn_info->def_q_idx;
928
929         con->src_mac_addr_hi = (conn_info->src_mac[5] << 8) |
930             conn_info->src_mac[4];
931         con->src_mac_addr_mid = (conn_info->src_mac[3] << 8) |
932             conn_info->src_mac[2];
933         con->src_mac_addr_lo = (conn_info->src_mac[1] << 8) |
934             conn_info->src_mac[0];
935         con->dst_mac_addr_hi = (conn_info->dst_mac[5] << 8) |
936             conn_info->dst_mac[4];
937         con->dst_mac_addr_mid = (conn_info->dst_mac[3] << 8) |
938             conn_info->dst_mac[2];
939         con->dst_mac_addr_lo = (conn_info->dst_mac[1] << 8) |
940             conn_info->dst_mac[0];
941
942         con->s_id.addr_hi = conn_info->s_id.addr_hi;
943         con->s_id.addr_mid = conn_info->s_id.addr_mid;
944         con->s_id.addr_lo = conn_info->s_id.addr_lo;
945         con->d_id.addr_hi = conn_info->d_id.addr_hi;
946         con->d_id.addr_mid = conn_info->d_id.addr_mid;
947         con->d_id.addr_lo = conn_info->d_id.addr_lo;
948
949         return qed_sp_fcoe_conn_offload(QED_AFFIN_HWFN(cdev), con,
950                                         QED_SPQ_MODE_EBLOCK, NULL);
951 }
952
953 static int qed_fcoe_destroy_conn(struct qed_dev *cdev,
954                                  u32 handle, dma_addr_t terminate_params)
955 {
956         struct qed_hash_fcoe_con *hash_con;
957         struct qed_fcoe_conn *con;
958
959         hash_con = qed_fcoe_get_hash(cdev, handle);
960         if (!hash_con) {
961                 DP_NOTICE(cdev, "Failed to find connection for handle %d\n",
962                           handle);
963                 return -EINVAL;
964         }
965
966         /* Update the connection with information from the params */
967         con = hash_con->con;
968         con->terminate_params = terminate_params;
969
970         return qed_sp_fcoe_conn_destroy(QED_AFFIN_HWFN(cdev), con,
971                                         QED_SPQ_MODE_EBLOCK, NULL);
972 }
973
974 static int qed_fcoe_stats(struct qed_dev *cdev, struct qed_fcoe_stats *stats)
975 {
976         return qed_fcoe_get_stats(QED_AFFIN_HWFN(cdev), stats);
977 }
978
979 void qed_get_protocol_stats_fcoe(struct qed_dev *cdev,
980                                  struct qed_mcp_fcoe_stats *stats)
981 {
982         struct qed_fcoe_stats proto_stats;
983
984         /* Retrieve FW statistics */
985         memset(&proto_stats, 0, sizeof(proto_stats));
986         if (qed_fcoe_stats(cdev, &proto_stats)) {
987                 DP_VERBOSE(cdev, QED_MSG_STORAGE,
988                            "Failed to collect FCoE statistics\n");
989                 return;
990         }
991
992         /* Translate FW statistics into struct */
993         stats->rx_pkts = proto_stats.fcoe_rx_data_pkt_cnt +
994                          proto_stats.fcoe_rx_xfer_pkt_cnt +
995                          proto_stats.fcoe_rx_other_pkt_cnt;
996         stats->tx_pkts = proto_stats.fcoe_tx_data_pkt_cnt +
997                          proto_stats.fcoe_tx_xfer_pkt_cnt +
998                          proto_stats.fcoe_tx_other_pkt_cnt;
999         stats->fcs_err = proto_stats.fcoe_silent_drop_pkt_crc_error_cnt;
1000
1001         /* Request protocol driver to fill-in the rest */
1002         if (cdev->protocol_ops.fcoe && cdev->ops_cookie) {
1003                 struct qed_fcoe_cb_ops *ops = cdev->protocol_ops.fcoe;
1004                 void *cookie = cdev->ops_cookie;
1005
1006                 if (ops->get_login_failures)
1007                         stats->login_failure = ops->get_login_failures(cookie);
1008         }
1009 }
1010
1011 static const struct qed_fcoe_ops qed_fcoe_ops_pass = {
1012         .common = &qed_common_ops_pass,
1013         .ll2 = &qed_ll2_ops_pass,
1014         .fill_dev_info = &qed_fill_fcoe_dev_info,
1015         .start = &qed_fcoe_start,
1016         .stop = &qed_fcoe_stop,
1017         .register_ops = &qed_register_fcoe_ops,
1018         .acquire_conn = &qed_fcoe_acquire_conn,
1019         .release_conn = &qed_fcoe_release_conn,
1020         .offload_conn = &qed_fcoe_offload_conn,
1021         .destroy_conn = &qed_fcoe_destroy_conn,
1022         .get_stats = &qed_fcoe_stats,
1023 };
1024
1025 const struct qed_fcoe_ops *qed_get_fcoe_ops(void)
1026 {
1027         return &qed_fcoe_ops_pass;
1028 }
1029 EXPORT_SYMBOL(qed_get_fcoe_ops);
1030
1031 void qed_put_fcoe_ops(void)
1032 {
1033 }
1034 EXPORT_SYMBOL(qed_put_fcoe_ops);