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