Commit | Line | Data |
---|---|---|
3287e96a | 1 | // SPDX-License-Identifier: GPL-2.0-only |
61d8658b DC |
2 | /* |
3 | * QLogic FCoE Offload Driver | |
5d1c8b5b | 4 | * Copyright (c) 2016-2018 Cavium Inc. |
61d8658b DC |
5 | */ |
6 | #include <linux/if_ether.h> | |
7 | #include <linux/if_vlan.h> | |
8 | #include "qedf.h" | |
9 | ||
10 | extern const struct qed_fcoe_ops *qed_ops; | |
11 | /* | |
12 | * FIP VLAN functions that will eventually move to libfcoe. | |
13 | */ | |
14 | ||
15 | void qedf_fcoe_send_vlan_req(struct qedf_ctx *qedf) | |
16 | { | |
17 | struct sk_buff *skb; | |
18 | char *eth_fr; | |
61d8658b DC |
19 | struct fip_vlan *vlan; |
20 | #define MY_FIP_ALL_FCF_MACS ((__u8[6]) { 1, 0x10, 0x18, 1, 0, 2 }) | |
21 | static u8 my_fcoe_all_fcfs[ETH_ALEN] = MY_FIP_ALL_FCF_MACS; | |
cac6f691 | 22 | unsigned long flags = 0; |
19c2b6d8 | 23 | int rc = -1; |
61d8658b DC |
24 | |
25 | skb = dev_alloc_skb(sizeof(struct fip_vlan)); | |
26 | if (!skb) | |
27 | return; | |
28 | ||
61d8658b DC |
29 | eth_fr = (char *)skb->data; |
30 | vlan = (struct fip_vlan *)eth_fr; | |
31 | ||
32 | memset(vlan, 0, sizeof(*vlan)); | |
33 | ether_addr_copy(vlan->eth.h_source, qedf->mac); | |
34 | ether_addr_copy(vlan->eth.h_dest, my_fcoe_all_fcfs); | |
35 | vlan->eth.h_proto = htons(ETH_P_FIP); | |
36 | ||
37 | vlan->fip.fip_ver = FIP_VER_ENCAPS(FIP_VER); | |
38 | vlan->fip.fip_op = htons(FIP_OP_VLAN); | |
39 | vlan->fip.fip_subcode = FIP_SC_VL_REQ; | |
40 | vlan->fip.fip_dl_len = htons(sizeof(vlan->desc) / FIP_BPW); | |
41 | ||
42 | vlan->desc.mac.fd_desc.fip_dtype = FIP_DT_MAC; | |
43 | vlan->desc.mac.fd_desc.fip_dlen = sizeof(vlan->desc.mac) / FIP_BPW; | |
44 | ether_addr_copy(vlan->desc.mac.fd_mac, qedf->mac); | |
45 | ||
46 | vlan->desc.wwnn.fd_desc.fip_dtype = FIP_DT_NAME; | |
47 | vlan->desc.wwnn.fd_desc.fip_dlen = sizeof(vlan->desc.wwnn) / FIP_BPW; | |
48 | put_unaligned_be64(qedf->lport->wwnn, &vlan->desc.wwnn.fd_wwn); | |
49 | ||
50 | skb_put(skb, sizeof(*vlan)); | |
51 | skb->protocol = htons(ETH_P_FIP); | |
52 | skb_reset_mac_header(skb); | |
53 | skb_reset_network_header(skb); | |
54 | ||
55 | QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC, "Sending FIP VLAN " | |
56 | "request."); | |
57 | ||
58 | if (atomic_read(&qedf->link_state) != QEDF_LINK_UP) { | |
59 | QEDF_WARN(&(qedf->dbg_ctx), "Cannot send vlan request " | |
60 | "because link is not up.\n"); | |
61 | ||
62 | kfree_skb(skb); | |
63 | return; | |
64 | } | |
cac6f691 SRK |
65 | |
66 | set_bit(QED_LL2_XMIT_FLAGS_FIP_DISCOVERY, &flags); | |
19c2b6d8 SK |
67 | rc = qed_ops->ll2->start_xmit(qedf->cdev, skb, flags); |
68 | if (rc) { | |
69 | QEDF_ERR(&qedf->dbg_ctx, "start_xmit failed rc = %d.\n", rc); | |
70 | kfree_skb(skb); | |
71 | return; | |
72 | } | |
73 | ||
61d8658b DC |
74 | } |
75 | ||
76 | static void qedf_fcoe_process_vlan_resp(struct qedf_ctx *qedf, | |
77 | struct sk_buff *skb) | |
78 | { | |
79 | struct fip_header *fiph; | |
80 | struct fip_desc *desc; | |
81 | u16 vid = 0; | |
82 | ssize_t rlen; | |
83 | size_t dlen; | |
84 | ||
85 | fiph = (struct fip_header *)(((void *)skb->data) + 2 * ETH_ALEN + 2); | |
86 | ||
87 | rlen = ntohs(fiph->fip_dl_len) * 4; | |
88 | desc = (struct fip_desc *)(fiph + 1); | |
89 | while (rlen > 0) { | |
90 | dlen = desc->fip_dlen * FIP_BPW; | |
91 | switch (desc->fip_dtype) { | |
92 | case FIP_DT_VLAN: | |
93 | vid = ntohs(((struct fip_vlan_desc *)desc)->fd_vlan); | |
94 | break; | |
95 | } | |
96 | desc = (struct fip_desc *)((char *)desc + dlen); | |
97 | rlen -= dlen; | |
98 | } | |
99 | ||
76dbf4ff SK |
100 | if (atomic_read(&qedf->link_state) == QEDF_LINK_DOWN) { |
101 | QEDF_INFO(&qedf->dbg_ctx, QEDF_LOG_DISC, | |
102 | "Dropping VLAN response as link is down.\n"); | |
103 | return; | |
104 | } | |
105 | ||
61d8658b DC |
106 | QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC, "VLAN response, " |
107 | "vid=0x%x.\n", vid); | |
108 | ||
109 | if (vid > 0 && qedf->vlan_id != vid) { | |
110 | qedf_set_vlan_id(qedf, vid); | |
111 | ||
112 | /* Inform waiter that it's ok to call fcoe_ctlr_link up() */ | |
8eaf7dfc CD |
113 | if (!completion_done(&qedf->fipvlan_compl)) |
114 | complete(&qedf->fipvlan_compl); | |
61d8658b DC |
115 | } |
116 | } | |
117 | ||
118 | void qedf_fip_send(struct fcoe_ctlr *fip, struct sk_buff *skb) | |
119 | { | |
120 | struct qedf_ctx *qedf = container_of(fip, struct qedf_ctx, ctlr); | |
121 | struct ethhdr *eth_hdr; | |
61d8658b DC |
122 | struct fip_header *fiph; |
123 | u16 op, vlan_tci = 0; | |
124 | u8 sub; | |
19c2b6d8 | 125 | int rc = -1; |
61d8658b DC |
126 | |
127 | if (!test_bit(QEDF_LL2_STARTED, &qedf->flags)) { | |
128 | QEDF_WARN(&(qedf->dbg_ctx), "LL2 not started\n"); | |
129 | kfree_skb(skb); | |
130 | return; | |
131 | } | |
132 | ||
133 | fiph = (struct fip_header *) ((void *)skb->data + 2 * ETH_ALEN + 2); | |
134 | eth_hdr = (struct ethhdr *)skb_mac_header(skb); | |
135 | op = ntohs(fiph->fip_op); | |
136 | sub = fiph->fip_subcode; | |
137 | ||
cf291163 CD |
138 | /* |
139 | * Add VLAN tag to non-offload FIP frame based on current stored VLAN | |
140 | * for FIP/FCoE traffic. | |
141 | */ | |
142 | __vlan_hwaccel_put_tag(skb, htons(ETH_P_8021Q), qedf->vlan_id); | |
61d8658b | 143 | |
cf291163 CD |
144 | /* Get VLAN ID from skb for printing purposes */ |
145 | __vlan_hwaccel_get_tag(skb, &vlan_tci); | |
61d8658b DC |
146 | |
147 | QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_LL2, "FIP frame send: " | |
148 | "dest=%pM op=%x sub=%x vlan=%04x.", eth_hdr->h_dest, op, sub, | |
15a93de7 | 149 | vlan_tci); |
61d8658b DC |
150 | if (qedf_dump_frames) |
151 | print_hex_dump(KERN_WARNING, "fip ", DUMP_PREFIX_OFFSET, 16, 1, | |
152 | skb->data, skb->len, false); | |
153 | ||
19c2b6d8 SK |
154 | rc = qed_ops->ll2->start_xmit(qedf->cdev, skb, 0); |
155 | if (rc) { | |
156 | QEDF_ERR(&qedf->dbg_ctx, "start_xmit failed rc = %d.\n", rc); | |
157 | kfree_skb(skb); | |
158 | return; | |
159 | } | |
61d8658b DC |
160 | } |
161 | ||
fc37ddce CD |
162 | static u8 fcoe_all_enode[ETH_ALEN] = FIP_ALL_ENODE_MACS; |
163 | ||
61d8658b DC |
164 | /* Process incoming FIP frames. */ |
165 | void qedf_fip_recv(struct qedf_ctx *qedf, struct sk_buff *skb) | |
166 | { | |
167 | struct ethhdr *eth_hdr; | |
168 | struct fip_header *fiph; | |
169 | struct fip_desc *desc; | |
170 | struct fip_mac_desc *mp; | |
171 | struct fip_wwn_desc *wp; | |
172 | struct fip_vn_desc *vp; | |
173 | size_t rlen, dlen; | |
61d8658b DC |
174 | u16 op; |
175 | u8 sub; | |
fc37ddce CD |
176 | bool fcf_valid = false; |
177 | /* Default is to handle CVL regardless of fabric id descriptor */ | |
178 | bool fabric_id_valid = true; | |
179 | bool fc_wwpn_valid = false; | |
180 | u64 switch_name; | |
181 | u16 vlan = 0; | |
61d8658b DC |
182 | |
183 | eth_hdr = (struct ethhdr *)skb_mac_header(skb); | |
184 | fiph = (struct fip_header *) ((void *)skb->data + 2 * ETH_ALEN + 2); | |
185 | op = ntohs(fiph->fip_op); | |
186 | sub = fiph->fip_subcode; | |
187 | ||
fc37ddce CD |
188 | QEDF_INFO(&qedf->dbg_ctx, QEDF_LOG_LL2, |
189 | "FIP frame received: skb=%p fiph=%p source=%pM destn=%pM op=%x sub=%x vlan=%04x", | |
190 | skb, fiph, eth_hdr->h_source, eth_hdr->h_dest, op, | |
191 | sub, vlan); | |
61d8658b DC |
192 | if (qedf_dump_frames) |
193 | print_hex_dump(KERN_WARNING, "fip ", DUMP_PREFIX_OFFSET, 16, 1, | |
194 | skb->data, skb->len, false); | |
195 | ||
fc37ddce CD |
196 | if (!ether_addr_equal(eth_hdr->h_dest, qedf->mac) && |
197 | !ether_addr_equal(eth_hdr->h_dest, fcoe_all_enode) && | |
198 | !ether_addr_equal(eth_hdr->h_dest, qedf->data_src_addr)) { | |
199 | QEDF_INFO(&qedf->dbg_ctx, QEDF_LOG_LL2, | |
200 | "Dropping FIP type 0x%x pkt due to destination MAC mismatch dest_mac=%pM ctlr.dest_addr=%pM data_src_addr=%pM.\n", | |
201 | op, eth_hdr->h_dest, qedf->mac, | |
202 | qedf->data_src_addr); | |
203 | kfree_skb(skb); | |
204 | return; | |
205 | } | |
206 | ||
61d8658b DC |
207 | /* Handle FIP VLAN resp in the driver */ |
208 | if (op == FIP_OP_VLAN && sub == FIP_SC_VL_NOTE) { | |
209 | qedf_fcoe_process_vlan_resp(qedf, skb); | |
61d8658b DC |
210 | kfree_skb(skb); |
211 | } else if (op == FIP_OP_CTRL && sub == FIP_SC_CLR_VLINK) { | |
212 | QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC, "Clear virtual " | |
213 | "link received.\n"); | |
214 | ||
215 | /* Check that an FCF has been selected by fcoe */ | |
216 | if (qedf->ctlr.sel_fcf == NULL) { | |
217 | QEDF_INFO(&(qedf->dbg_ctx), QEDF_LOG_DISC, | |
218 | "Dropping CVL since FCF has not been selected " | |
219 | "yet."); | |
f32803bb | 220 | kfree_skb(skb); |
61d8658b DC |
221 | return; |
222 | } | |
223 | ||
61d8658b DC |
224 | /* |
225 | * We need to loop through the CVL descriptors to determine | |
226 | * if we want to reset the fcoe link | |
227 | */ | |
228 | rlen = ntohs(fiph->fip_dl_len) * FIP_BPW; | |
229 | desc = (struct fip_desc *)(fiph + 1); | |
230 | while (rlen >= sizeof(*desc)) { | |
231 | dlen = desc->fip_dlen * FIP_BPW; | |
232 | switch (desc->fip_dtype) { | |
233 | case FIP_DT_MAC: | |
234 | mp = (struct fip_mac_desc *)desc; | |
fc37ddce CD |
235 | QEDF_INFO(&qedf->dbg_ctx, QEDF_LOG_DISC, |
236 | "Switch fd_mac=%pM.\n", mp->fd_mac); | |
53c51adb CD |
237 | if (ether_addr_equal(mp->fd_mac, |
238 | qedf->ctlr.sel_fcf->fcf_mac)) | |
fc37ddce | 239 | fcf_valid = true; |
61d8658b DC |
240 | break; |
241 | case FIP_DT_NAME: | |
242 | wp = (struct fip_wwn_desc *)desc; | |
fc37ddce CD |
243 | switch_name = get_unaligned_be64(&wp->fd_wwn); |
244 | QEDF_INFO(&qedf->dbg_ctx, QEDF_LOG_DISC, | |
245 | "Switch fd_wwn=%016llx fcf_switch_name=%016llx.\n", | |
246 | switch_name, | |
247 | qedf->ctlr.sel_fcf->switch_name); | |
248 | if (switch_name == | |
249 | qedf->ctlr.sel_fcf->switch_name) | |
250 | fc_wwpn_valid = true; | |
61d8658b DC |
251 | break; |
252 | case FIP_DT_VN_ID: | |
253 | vp = (struct fip_vn_desc *)desc; | |
fc37ddce CD |
254 | QEDF_INFO(&qedf->dbg_ctx, QEDF_LOG_DISC, |
255 | "vx_port fd_fc_id=%x fd_mac=%pM.\n", | |
256 | ntoh24(vp->fd_fc_id), vp->fd_mac); | |
257 | /* Check vx_port fabric ID */ | |
258 | if (ntoh24(vp->fd_fc_id) != | |
53c51adb | 259 | qedf->lport->port_id) |
fc37ddce CD |
260 | fabric_id_valid = false; |
261 | /* Check vx_port MAC */ | |
262 | if (!ether_addr_equal(vp->fd_mac, | |
263 | qedf->data_src_addr)) | |
264 | fabric_id_valid = false; | |
61d8658b DC |
265 | break; |
266 | default: | |
267 | /* Ignore anything else */ | |
268 | break; | |
269 | } | |
270 | desc = (struct fip_desc *)((char *)desc + dlen); | |
271 | rlen -= dlen; | |
272 | } | |
273 | ||
fc37ddce CD |
274 | QEDF_INFO(&qedf->dbg_ctx, QEDF_LOG_DISC, |
275 | "fcf_valid=%d fabric_id_valid=%d fc_wwpn_valid=%d.\n", | |
276 | fcf_valid, fabric_id_valid, fc_wwpn_valid); | |
277 | if (fcf_valid && fabric_id_valid && fc_wwpn_valid) | |
a66c6cd2 | 278 | qedf_ctx_soft_reset(qedf->lport); |
61d8658b DC |
279 | kfree_skb(skb); |
280 | } else { | |
281 | /* Everything else is handled by libfcoe */ | |
282 | __skb_pull(skb, ETH_HLEN); | |
283 | fcoe_ctlr_recv(&qedf->ctlr, skb); | |
284 | } | |
285 | } | |
286 | ||
61d8658b DC |
287 | u8 *qedf_get_src_mac(struct fc_lport *lport) |
288 | { | |
61d8658b DC |
289 | struct qedf_ctx *qedf = lport_priv(lport); |
290 | ||
61d8658b DC |
291 | return qedf->data_src_addr; |
292 | } |