| Vasu Dev | 9b34ecf | 2009-03-17 11:42:13 -0700 | [diff] [blame] | 1 | /* | 
| Joe Eykholt | 97c8389 | 2009-03-17 11:42:40 -0700 | [diff] [blame] | 2 | * Copyright (c) 2008-2009 Cisco Systems, Inc.  All rights reserved. | 
|  | 3 | * Copyright (c) 2009 Intel Corporation.  All rights reserved. | 
| Vasu Dev | 9b34ecf | 2009-03-17 11:42:13 -0700 | [diff] [blame] | 4 | * | 
|  | 5 | * This program is free software; you can redistribute it and/or modify it | 
|  | 6 | * under the terms and conditions of the GNU General Public License, | 
|  | 7 | * version 2, as published by the Free Software Foundation. | 
|  | 8 | * | 
|  | 9 | * This program is distributed in the hope it will be useful, but WITHOUT | 
|  | 10 | * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or | 
|  | 11 | * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for | 
|  | 12 | * more details. | 
|  | 13 | * | 
|  | 14 | * You should have received a copy of the GNU General Public License along with | 
|  | 15 | * this program; if not, write to the Free Software Foundation, Inc., | 
|  | 16 | * 51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA. | 
|  | 17 | * | 
|  | 18 | * Maintained at www.Open-FCoE.org | 
|  | 19 | */ | 
|  | 20 |  | 
| Joe Eykholt | 97c8389 | 2009-03-17 11:42:40 -0700 | [diff] [blame] | 21 | #include <linux/types.h> | 
| Vasu Dev | 9b34ecf | 2009-03-17 11:42:13 -0700 | [diff] [blame] | 22 | #include <linux/module.h> | 
| Joe Eykholt | 97c8389 | 2009-03-17 11:42:40 -0700 | [diff] [blame] | 23 | #include <linux/kernel.h> | 
|  | 24 | #include <linux/list.h> | 
|  | 25 | #include <linux/spinlock.h> | 
|  | 26 | #include <linux/timer.h> | 
| Vasu Dev | 5e80f7f | 2009-03-17 11:42:18 -0700 | [diff] [blame] | 27 | #include <linux/netdevice.h> | 
| Joe Eykholt | 97c8389 | 2009-03-17 11:42:40 -0700 | [diff] [blame] | 28 | #include <linux/etherdevice.h> | 
|  | 29 | #include <linux/ethtool.h> | 
|  | 30 | #include <linux/if_ether.h> | 
|  | 31 | #include <linux/if_vlan.h> | 
|  | 32 | #include <linux/netdevice.h> | 
|  | 33 | #include <linux/errno.h> | 
|  | 34 | #include <linux/bitops.h> | 
|  | 35 | #include <net/rtnetlink.h> | 
|  | 36 |  | 
|  | 37 | #include <scsi/fc/fc_els.h> | 
|  | 38 | #include <scsi/fc/fc_fs.h> | 
|  | 39 | #include <scsi/fc/fc_fip.h> | 
|  | 40 | #include <scsi/fc/fc_encaps.h> | 
|  | 41 | #include <scsi/fc/fc_fcoe.h> | 
| Vasu Dev | 5e80f7f | 2009-03-17 11:42:18 -0700 | [diff] [blame] | 42 |  | 
|  | 43 | #include <scsi/libfc.h> | 
| Joe Eykholt | 97c8389 | 2009-03-17 11:42:40 -0700 | [diff] [blame] | 44 | #include <scsi/libfcoe.h> | 
| Vasu Dev | 9b34ecf | 2009-03-17 11:42:13 -0700 | [diff] [blame] | 45 |  | 
|  | 46 | MODULE_AUTHOR("Open-FCoE.org"); | 
| Joe Eykholt | 97c8389 | 2009-03-17 11:42:40 -0700 | [diff] [blame] | 47 | MODULE_DESCRIPTION("FIP discovery protocol support for FCoE HBAs"); | 
| Vasu Dev | 9b34ecf | 2009-03-17 11:42:13 -0700 | [diff] [blame] | 48 | MODULE_LICENSE("GPL v2"); | 
| Vasu Dev | 5e80f7f | 2009-03-17 11:42:18 -0700 | [diff] [blame] | 49 |  | 
| Joe Eykholt | 97c8389 | 2009-03-17 11:42:40 -0700 | [diff] [blame] | 50 | #define	FCOE_CTLR_MIN_FKA	500		/* min keep alive (mS) */ | 
|  | 51 | #define	FCOE_CTLR_DEF_FKA	FIP_DEF_FKA	/* default keep alive (mS) */ | 
|  | 52 |  | 
|  | 53 | static void fcoe_ctlr_timeout(unsigned long); | 
|  | 54 | static void fcoe_ctlr_link_work(struct work_struct *); | 
|  | 55 | static void fcoe_ctlr_recv_work(struct work_struct *); | 
|  | 56 |  | 
|  | 57 | static u8 fcoe_all_fcfs[ETH_ALEN] = FIP_ALL_FCF_MACS; | 
|  | 58 |  | 
|  | 59 | static u32 fcoe_ctlr_debug;	/* 1 for basic, 2 for noisy debug */ | 
|  | 60 |  | 
|  | 61 | #define FIP_DBG_LVL(level, fmt, args...) 				\ | 
|  | 62 | do {							\ | 
|  | 63 | if (fcoe_ctlr_debug >= (level))			\ | 
|  | 64 | FC_DBG(fmt, ##args);			\ | 
|  | 65 | } while (0) | 
|  | 66 |  | 
|  | 67 | #define FIP_DBG(fmt, args...)	FIP_DBG_LVL(1, fmt, ##args) | 
|  | 68 |  | 
|  | 69 | /* | 
|  | 70 | * Return non-zero if FCF fcoe_size has been validated. | 
|  | 71 | */ | 
|  | 72 | static inline int fcoe_ctlr_mtu_valid(const struct fcoe_fcf *fcf) | 
|  | 73 | { | 
|  | 74 | return (fcf->flags & FIP_FL_SOL) != 0; | 
|  | 75 | } | 
|  | 76 |  | 
|  | 77 | /* | 
|  | 78 | * Return non-zero if the FCF is usable. | 
|  | 79 | */ | 
|  | 80 | static inline int fcoe_ctlr_fcf_usable(struct fcoe_fcf *fcf) | 
|  | 81 | { | 
|  | 82 | u16 flags = FIP_FL_SOL | FIP_FL_AVAIL; | 
|  | 83 |  | 
|  | 84 | return (fcf->flags & flags) == flags; | 
|  | 85 | } | 
|  | 86 |  | 
|  | 87 | /** | 
|  | 88 | * fcoe_ctlr_init() - Initialize the FCoE Controller instance. | 
|  | 89 | * @fip:	FCoE controller. | 
|  | 90 | */ | 
|  | 91 | void fcoe_ctlr_init(struct fcoe_ctlr *fip) | 
|  | 92 | { | 
|  | 93 | fip->state = FIP_ST_LINK_WAIT; | 
|  | 94 | INIT_LIST_HEAD(&fip->fcfs); | 
|  | 95 | spin_lock_init(&fip->lock); | 
|  | 96 | fip->flogi_oxid = FC_XID_UNKNOWN; | 
|  | 97 | setup_timer(&fip->timer, fcoe_ctlr_timeout, (unsigned long)fip); | 
|  | 98 | INIT_WORK(&fip->link_work, fcoe_ctlr_link_work); | 
|  | 99 | INIT_WORK(&fip->recv_work, fcoe_ctlr_recv_work); | 
|  | 100 | skb_queue_head_init(&fip->fip_recv_list); | 
|  | 101 | } | 
|  | 102 | EXPORT_SYMBOL(fcoe_ctlr_init); | 
|  | 103 |  | 
|  | 104 | /** | 
|  | 105 | * fcoe_ctlr_reset_fcfs() - Reset and free all FCFs for a controller. | 
|  | 106 | * @fip:	FCoE controller. | 
|  | 107 | * | 
|  | 108 | * Called with &fcoe_ctlr lock held. | 
|  | 109 | */ | 
|  | 110 | static void fcoe_ctlr_reset_fcfs(struct fcoe_ctlr *fip) | 
|  | 111 | { | 
|  | 112 | struct fcoe_fcf *fcf; | 
|  | 113 | struct fcoe_fcf *next; | 
|  | 114 |  | 
|  | 115 | fip->sel_fcf = NULL; | 
|  | 116 | list_for_each_entry_safe(fcf, next, &fip->fcfs, list) { | 
|  | 117 | list_del(&fcf->list); | 
|  | 118 | kfree(fcf); | 
|  | 119 | } | 
|  | 120 | fip->fcf_count = 0; | 
|  | 121 | fip->sel_time = 0; | 
|  | 122 | } | 
|  | 123 |  | 
|  | 124 | /** | 
| Chris Leech | dd3fd72 | 2009-04-21 16:27:36 -0700 | [diff] [blame] | 125 | * fcoe_ctlr_destroy() - Disable and tear-down the FCoE controller. | 
| Joe Eykholt | 97c8389 | 2009-03-17 11:42:40 -0700 | [diff] [blame] | 126 | * @fip:	FCoE controller. | 
|  | 127 | * | 
|  | 128 | * This is called by FCoE drivers before freeing the &fcoe_ctlr. | 
|  | 129 | * | 
|  | 130 | * The receive handler will have been deleted before this to guarantee | 
|  | 131 | * that no more recv_work will be scheduled. | 
|  | 132 | * | 
|  | 133 | * The timer routine will simply return once we set FIP_ST_DISABLED. | 
|  | 134 | * This guarantees that no further timeouts or work will be scheduled. | 
|  | 135 | */ | 
|  | 136 | void fcoe_ctlr_destroy(struct fcoe_ctlr *fip) | 
|  | 137 | { | 
|  | 138 | flush_work(&fip->recv_work); | 
|  | 139 | spin_lock_bh(&fip->lock); | 
|  | 140 | fip->state = FIP_ST_DISABLED; | 
|  | 141 | fcoe_ctlr_reset_fcfs(fip); | 
|  | 142 | spin_unlock_bh(&fip->lock); | 
|  | 143 | del_timer_sync(&fip->timer); | 
|  | 144 | flush_work(&fip->link_work); | 
|  | 145 | } | 
|  | 146 | EXPORT_SYMBOL(fcoe_ctlr_destroy); | 
|  | 147 |  | 
|  | 148 | /** | 
|  | 149 | * fcoe_ctlr_fcoe_size() - Return the maximum FCoE size required for VN_Port. | 
|  | 150 | * @fip:	FCoE controller. | 
|  | 151 | * | 
|  | 152 | * Returns the maximum packet size including the FCoE header and trailer, | 
|  | 153 | * but not including any Ethernet or VLAN headers. | 
|  | 154 | */ | 
|  | 155 | static inline u32 fcoe_ctlr_fcoe_size(struct fcoe_ctlr *fip) | 
|  | 156 | { | 
|  | 157 | /* | 
|  | 158 | * Determine the max FCoE frame size allowed, including | 
|  | 159 | * FCoE header and trailer. | 
|  | 160 | * Note:  lp->mfs is currently the payload size, not the frame size. | 
|  | 161 | */ | 
|  | 162 | return fip->lp->mfs + sizeof(struct fc_frame_header) + | 
|  | 163 | sizeof(struct fcoe_hdr) + sizeof(struct fcoe_crc_eof); | 
|  | 164 | } | 
|  | 165 |  | 
|  | 166 | /** | 
|  | 167 | * fcoe_ctlr_solicit() - Send a solicitation. | 
|  | 168 | * @fip:	FCoE controller. | 
|  | 169 | * @fcf:	Destination FCF.  If NULL, a multicast solicitation is sent. | 
|  | 170 | */ | 
|  | 171 | static void fcoe_ctlr_solicit(struct fcoe_ctlr *fip, struct fcoe_fcf *fcf) | 
|  | 172 | { | 
|  | 173 | struct sk_buff *skb; | 
|  | 174 | struct fip_sol { | 
|  | 175 | struct ethhdr eth; | 
|  | 176 | struct fip_header fip; | 
|  | 177 | struct { | 
|  | 178 | struct fip_mac_desc mac; | 
|  | 179 | struct fip_wwn_desc wwnn; | 
|  | 180 | struct fip_size_desc size; | 
|  | 181 | } __attribute__((packed)) desc; | 
|  | 182 | }  __attribute__((packed)) *sol; | 
|  | 183 | u32 fcoe_size; | 
|  | 184 |  | 
|  | 185 | skb = dev_alloc_skb(sizeof(*sol)); | 
|  | 186 | if (!skb) | 
|  | 187 | return; | 
|  | 188 |  | 
|  | 189 | sol = (struct fip_sol *)skb->data; | 
|  | 190 |  | 
|  | 191 | memset(sol, 0, sizeof(*sol)); | 
|  | 192 | memcpy(sol->eth.h_dest, fcf ? fcf->fcf_mac : fcoe_all_fcfs, ETH_ALEN); | 
|  | 193 | memcpy(sol->eth.h_source, fip->ctl_src_addr, ETH_ALEN); | 
|  | 194 | sol->eth.h_proto = htons(ETH_P_FIP); | 
|  | 195 |  | 
|  | 196 | sol->fip.fip_ver = FIP_VER_ENCAPS(FIP_VER); | 
|  | 197 | sol->fip.fip_op = htons(FIP_OP_DISC); | 
|  | 198 | sol->fip.fip_subcode = FIP_SC_SOL; | 
|  | 199 | sol->fip.fip_dl_len = htons(sizeof(sol->desc) / FIP_BPW); | 
|  | 200 | sol->fip.fip_flags = htons(FIP_FL_FPMA); | 
|  | 201 |  | 
|  | 202 | sol->desc.mac.fd_desc.fip_dtype = FIP_DT_MAC; | 
|  | 203 | sol->desc.mac.fd_desc.fip_dlen = sizeof(sol->desc.mac) / FIP_BPW; | 
|  | 204 | memcpy(sol->desc.mac.fd_mac, fip->ctl_src_addr, ETH_ALEN); | 
|  | 205 |  | 
|  | 206 | sol->desc.wwnn.fd_desc.fip_dtype = FIP_DT_NAME; | 
|  | 207 | sol->desc.wwnn.fd_desc.fip_dlen = sizeof(sol->desc.wwnn) / FIP_BPW; | 
|  | 208 | put_unaligned_be64(fip->lp->wwnn, &sol->desc.wwnn.fd_wwn); | 
|  | 209 |  | 
|  | 210 | fcoe_size = fcoe_ctlr_fcoe_size(fip); | 
|  | 211 | sol->desc.size.fd_desc.fip_dtype = FIP_DT_FCOE_SIZE; | 
|  | 212 | sol->desc.size.fd_desc.fip_dlen = sizeof(sol->desc.size) / FIP_BPW; | 
|  | 213 | sol->desc.size.fd_size = htons(fcoe_size); | 
|  | 214 |  | 
|  | 215 | skb_put(skb, sizeof(*sol)); | 
|  | 216 | skb->protocol = htons(ETH_P_802_3); | 
|  | 217 | skb_reset_mac_header(skb); | 
|  | 218 | skb_reset_network_header(skb); | 
|  | 219 | fip->send(fip, skb); | 
|  | 220 |  | 
|  | 221 | if (!fcf) | 
|  | 222 | fip->sol_time = jiffies; | 
|  | 223 | } | 
|  | 224 |  | 
|  | 225 | /** | 
|  | 226 | * fcoe_ctlr_link_up() - Start FCoE controller. | 
|  | 227 | * @fip:	FCoE controller. | 
|  | 228 | * | 
|  | 229 | * Called from the LLD when the network link is ready. | 
|  | 230 | */ | 
|  | 231 | void fcoe_ctlr_link_up(struct fcoe_ctlr *fip) | 
|  | 232 | { | 
|  | 233 | spin_lock_bh(&fip->lock); | 
|  | 234 | if (fip->state == FIP_ST_NON_FIP || fip->state == FIP_ST_AUTO) { | 
|  | 235 | fip->last_link = 1; | 
|  | 236 | fip->link = 1; | 
|  | 237 | spin_unlock_bh(&fip->lock); | 
|  | 238 | fc_linkup(fip->lp); | 
|  | 239 | } else if (fip->state == FIP_ST_LINK_WAIT) { | 
|  | 240 | fip->state = FIP_ST_AUTO; | 
|  | 241 | fip->last_link = 1; | 
|  | 242 | fip->link = 1; | 
|  | 243 | spin_unlock_bh(&fip->lock); | 
|  | 244 | FIP_DBG("%s", "setting AUTO mode.\n"); | 
|  | 245 | fc_linkup(fip->lp); | 
|  | 246 | fcoe_ctlr_solicit(fip, NULL); | 
|  | 247 | } else | 
|  | 248 | spin_unlock_bh(&fip->lock); | 
|  | 249 | } | 
|  | 250 | EXPORT_SYMBOL(fcoe_ctlr_link_up); | 
|  | 251 |  | 
|  | 252 | /** | 
|  | 253 | * fcoe_ctlr_reset() - Reset FIP. | 
|  | 254 | * @fip:	FCoE controller. | 
|  | 255 | * @new_state:	FIP state to be entered. | 
|  | 256 | * | 
|  | 257 | * Returns non-zero if the link was up and now isn't. | 
|  | 258 | */ | 
|  | 259 | static int fcoe_ctlr_reset(struct fcoe_ctlr *fip, enum fip_state new_state) | 
|  | 260 | { | 
|  | 261 | struct fc_lport *lp = fip->lp; | 
|  | 262 | int link_dropped; | 
|  | 263 |  | 
|  | 264 | spin_lock_bh(&fip->lock); | 
|  | 265 | fcoe_ctlr_reset_fcfs(fip); | 
|  | 266 | del_timer(&fip->timer); | 
|  | 267 | fip->state = new_state; | 
|  | 268 | fip->ctlr_ka_time = 0; | 
|  | 269 | fip->port_ka_time = 0; | 
|  | 270 | fip->sol_time = 0; | 
|  | 271 | fip->flogi_oxid = FC_XID_UNKNOWN; | 
|  | 272 | fip->map_dest = 0; | 
|  | 273 | fip->last_link = 0; | 
|  | 274 | link_dropped = fip->link; | 
|  | 275 | fip->link = 0; | 
|  | 276 | spin_unlock_bh(&fip->lock); | 
|  | 277 |  | 
|  | 278 | if (link_dropped) | 
|  | 279 | fc_linkdown(lp); | 
|  | 280 |  | 
|  | 281 | if (new_state == FIP_ST_ENABLED) { | 
|  | 282 | fcoe_ctlr_solicit(fip, NULL); | 
|  | 283 | fc_linkup(lp); | 
|  | 284 | link_dropped = 0; | 
|  | 285 | } | 
|  | 286 | return link_dropped; | 
|  | 287 | } | 
|  | 288 |  | 
|  | 289 | /** | 
|  | 290 | * fcoe_ctlr_link_down() - Stop FCoE controller. | 
|  | 291 | * @fip:	FCoE controller. | 
|  | 292 | * | 
|  | 293 | * Returns non-zero if the link was up and now isn't. | 
|  | 294 | * | 
|  | 295 | * Called from the LLD when the network link is not ready. | 
|  | 296 | * There may be multiple calls while the link is down. | 
|  | 297 | */ | 
|  | 298 | int fcoe_ctlr_link_down(struct fcoe_ctlr *fip) | 
|  | 299 | { | 
|  | 300 | return fcoe_ctlr_reset(fip, FIP_ST_LINK_WAIT); | 
|  | 301 | } | 
|  | 302 | EXPORT_SYMBOL(fcoe_ctlr_link_down); | 
|  | 303 |  | 
|  | 304 | /** | 
|  | 305 | * fcoe_ctlr_send_keep_alive() - Send a keep-alive to the selected FCF. | 
|  | 306 | * @fip:	FCoE controller. | 
|  | 307 | * @ports:	0 for controller keep-alive, 1 for port keep-alive. | 
|  | 308 | * @sa:		source MAC address. | 
|  | 309 | * | 
|  | 310 | * A controller keep-alive is sent every fka_period (typically 8 seconds). | 
|  | 311 | * The source MAC is the native MAC address. | 
|  | 312 | * | 
|  | 313 | * A port keep-alive is sent every 90 seconds while logged in. | 
|  | 314 | * The source MAC is the assigned mapped source address. | 
|  | 315 | * The destination is the FCF's F-port. | 
|  | 316 | */ | 
|  | 317 | static void fcoe_ctlr_send_keep_alive(struct fcoe_ctlr *fip, int ports, u8 *sa) | 
|  | 318 | { | 
|  | 319 | struct sk_buff *skb; | 
|  | 320 | struct fip_kal { | 
|  | 321 | struct ethhdr eth; | 
|  | 322 | struct fip_header fip; | 
|  | 323 | struct fip_mac_desc mac; | 
|  | 324 | } __attribute__((packed)) *kal; | 
|  | 325 | struct fip_vn_desc *vn; | 
|  | 326 | u32 len; | 
|  | 327 | struct fc_lport *lp; | 
|  | 328 | struct fcoe_fcf *fcf; | 
|  | 329 |  | 
|  | 330 | fcf = fip->sel_fcf; | 
|  | 331 | lp = fip->lp; | 
|  | 332 | if (!fcf || !fc_host_port_id(lp->host)) | 
|  | 333 | return; | 
|  | 334 |  | 
|  | 335 | len = fcoe_ctlr_fcoe_size(fip) + sizeof(struct ethhdr); | 
|  | 336 | BUG_ON(len < sizeof(*kal) + sizeof(*vn)); | 
|  | 337 | skb = dev_alloc_skb(len); | 
|  | 338 | if (!skb) | 
|  | 339 | return; | 
|  | 340 |  | 
|  | 341 | kal = (struct fip_kal *)skb->data; | 
|  | 342 | memset(kal, 0, len); | 
|  | 343 | memcpy(kal->eth.h_dest, fcf->fcf_mac, ETH_ALEN); | 
|  | 344 | memcpy(kal->eth.h_source, sa, ETH_ALEN); | 
|  | 345 | kal->eth.h_proto = htons(ETH_P_FIP); | 
|  | 346 |  | 
|  | 347 | kal->fip.fip_ver = FIP_VER_ENCAPS(FIP_VER); | 
|  | 348 | kal->fip.fip_op = htons(FIP_OP_CTRL); | 
|  | 349 | kal->fip.fip_subcode = FIP_SC_KEEP_ALIVE; | 
|  | 350 | kal->fip.fip_dl_len = htons((sizeof(kal->mac) + | 
|  | 351 | ports * sizeof(*vn)) / FIP_BPW); | 
|  | 352 | kal->fip.fip_flags = htons(FIP_FL_FPMA); | 
|  | 353 |  | 
|  | 354 | kal->mac.fd_desc.fip_dtype = FIP_DT_MAC; | 
|  | 355 | kal->mac.fd_desc.fip_dlen = sizeof(kal->mac) / FIP_BPW; | 
|  | 356 | memcpy(kal->mac.fd_mac, fip->ctl_src_addr, ETH_ALEN); | 
|  | 357 |  | 
|  | 358 | if (ports) { | 
|  | 359 | vn = (struct fip_vn_desc *)(kal + 1); | 
|  | 360 | vn->fd_desc.fip_dtype = FIP_DT_VN_ID; | 
|  | 361 | vn->fd_desc.fip_dlen = sizeof(*vn) / FIP_BPW; | 
|  | 362 | memcpy(vn->fd_mac, fip->data_src_addr, ETH_ALEN); | 
|  | 363 | hton24(vn->fd_fc_id, fc_host_port_id(lp->host)); | 
|  | 364 | put_unaligned_be64(lp->wwpn, &vn->fd_wwpn); | 
|  | 365 | } | 
|  | 366 |  | 
|  | 367 | skb_put(skb, len); | 
|  | 368 | skb->protocol = htons(ETH_P_802_3); | 
|  | 369 | skb_reset_mac_header(skb); | 
|  | 370 | skb_reset_network_header(skb); | 
|  | 371 | fip->send(fip, skb); | 
|  | 372 | } | 
|  | 373 |  | 
|  | 374 | /** | 
|  | 375 | * fcoe_ctlr_encaps() - Encapsulate an ELS frame for FIP, without sending it. | 
|  | 376 | * @fip:	FCoE controller. | 
|  | 377 | * @dtype:	FIP descriptor type for the frame. | 
|  | 378 | * @skb:	FCoE ELS frame including FC header but no FCoE headers. | 
|  | 379 | * | 
|  | 380 | * Returns non-zero error code on failure. | 
|  | 381 | * | 
|  | 382 | * The caller must check that the length is a multiple of 4. | 
|  | 383 | * | 
|  | 384 | * The @skb must have enough headroom (28 bytes) and tailroom (8 bytes). | 
|  | 385 | * Headroom includes the FIP encapsulation description, FIP header, and | 
|  | 386 | * Ethernet header.  The tailroom is for the FIP MAC descriptor. | 
|  | 387 | */ | 
|  | 388 | static int fcoe_ctlr_encaps(struct fcoe_ctlr *fip, | 
|  | 389 | u8 dtype, struct sk_buff *skb) | 
|  | 390 | { | 
|  | 391 | struct fip_encaps_head { | 
|  | 392 | struct ethhdr eth; | 
|  | 393 | struct fip_header fip; | 
|  | 394 | struct fip_encaps encaps; | 
|  | 395 | } __attribute__((packed)) *cap; | 
|  | 396 | struct fip_mac_desc *mac; | 
|  | 397 | struct fcoe_fcf *fcf; | 
|  | 398 | size_t dlen; | 
|  | 399 |  | 
|  | 400 | fcf = fip->sel_fcf; | 
|  | 401 | if (!fcf) | 
|  | 402 | return -ENODEV; | 
|  | 403 | dlen = sizeof(struct fip_encaps) + skb->len;	/* len before push */ | 
|  | 404 | cap = (struct fip_encaps_head *)skb_push(skb, sizeof(*cap)); | 
|  | 405 |  | 
|  | 406 | memset(cap, 0, sizeof(*cap)); | 
|  | 407 | memcpy(cap->eth.h_dest, fcf->fcf_mac, ETH_ALEN); | 
|  | 408 | memcpy(cap->eth.h_source, fip->ctl_src_addr, ETH_ALEN); | 
|  | 409 | cap->eth.h_proto = htons(ETH_P_FIP); | 
|  | 410 |  | 
|  | 411 | cap->fip.fip_ver = FIP_VER_ENCAPS(FIP_VER); | 
|  | 412 | cap->fip.fip_op = htons(FIP_OP_LS); | 
|  | 413 | cap->fip.fip_subcode = FIP_SC_REQ; | 
|  | 414 | cap->fip.fip_dl_len = htons((dlen + sizeof(*mac)) / FIP_BPW); | 
|  | 415 | cap->fip.fip_flags = htons(FIP_FL_FPMA); | 
|  | 416 |  | 
|  | 417 | cap->encaps.fd_desc.fip_dtype = dtype; | 
|  | 418 | cap->encaps.fd_desc.fip_dlen = dlen / FIP_BPW; | 
|  | 419 |  | 
|  | 420 | mac = (struct fip_mac_desc *)skb_put(skb, sizeof(*mac)); | 
|  | 421 | memset(mac, 0, sizeof(mac)); | 
|  | 422 | mac->fd_desc.fip_dtype = FIP_DT_MAC; | 
|  | 423 | mac->fd_desc.fip_dlen = sizeof(*mac) / FIP_BPW; | 
|  | 424 | if (dtype != ELS_FLOGI) | 
|  | 425 | memcpy(mac->fd_mac, fip->data_src_addr, ETH_ALEN); | 
|  | 426 |  | 
|  | 427 | skb->protocol = htons(ETH_P_802_3); | 
|  | 428 | skb_reset_mac_header(skb); | 
|  | 429 | skb_reset_network_header(skb); | 
|  | 430 | return 0; | 
|  | 431 | } | 
|  | 432 |  | 
|  | 433 | /** | 
|  | 434 | * fcoe_ctlr_els_send() - Send an ELS frame encapsulated by FIP if appropriate. | 
|  | 435 | * @fip:	FCoE controller. | 
|  | 436 | * @skb:	FCoE ELS frame including FC header but no FCoE headers. | 
|  | 437 | * | 
|  | 438 | * Returns a non-zero error code if the frame should not be sent. | 
|  | 439 | * Returns zero if the caller should send the frame with FCoE encapsulation. | 
|  | 440 | * | 
|  | 441 | * The caller must check that the length is a multiple of 4. | 
|  | 442 | * The SKB must have enough headroom (28 bytes) and tailroom (8 bytes). | 
|  | 443 | */ | 
|  | 444 | int fcoe_ctlr_els_send(struct fcoe_ctlr *fip, struct sk_buff *skb) | 
|  | 445 | { | 
|  | 446 | struct fc_frame_header *fh; | 
|  | 447 | u16 old_xid; | 
|  | 448 | u8 op; | 
|  | 449 |  | 
|  | 450 | if (fip->state == FIP_ST_NON_FIP) | 
|  | 451 | return 0; | 
|  | 452 |  | 
|  | 453 | fh = (struct fc_frame_header *)skb->data; | 
|  | 454 | op = *(u8 *)(fh + 1); | 
|  | 455 |  | 
|  | 456 | switch (op) { | 
|  | 457 | case ELS_FLOGI: | 
|  | 458 | old_xid = fip->flogi_oxid; | 
|  | 459 | fip->flogi_oxid = ntohs(fh->fh_ox_id); | 
|  | 460 | if (fip->state == FIP_ST_AUTO) { | 
|  | 461 | if (old_xid == FC_XID_UNKNOWN) | 
|  | 462 | fip->flogi_count = 0; | 
|  | 463 | fip->flogi_count++; | 
|  | 464 | if (fip->flogi_count < 3) | 
|  | 465 | goto drop; | 
|  | 466 | fip->map_dest = 1; | 
|  | 467 | return 0; | 
|  | 468 | } | 
|  | 469 | op = FIP_DT_FLOGI; | 
|  | 470 | break; | 
|  | 471 | case ELS_FDISC: | 
|  | 472 | if (ntoh24(fh->fh_s_id)) | 
|  | 473 | return 0; | 
|  | 474 | op = FIP_DT_FDISC; | 
|  | 475 | break; | 
|  | 476 | case ELS_LOGO: | 
|  | 477 | if (fip->state != FIP_ST_ENABLED) | 
|  | 478 | return 0; | 
|  | 479 | if (ntoh24(fh->fh_d_id) != FC_FID_FLOGI) | 
|  | 480 | return 0; | 
|  | 481 | op = FIP_DT_LOGO; | 
|  | 482 | break; | 
|  | 483 | case ELS_LS_ACC: | 
|  | 484 | if (fip->flogi_oxid == FC_XID_UNKNOWN) | 
|  | 485 | return 0; | 
|  | 486 | if (!ntoh24(fh->fh_s_id)) | 
|  | 487 | return 0; | 
|  | 488 | if (fip->state == FIP_ST_AUTO) | 
|  | 489 | return 0; | 
|  | 490 | /* | 
|  | 491 | * Here we must've gotten an SID by accepting an FLOGI | 
|  | 492 | * from a point-to-point connection.  Switch to using | 
|  | 493 | * the source mac based on the SID.  The destination | 
|  | 494 | * MAC in this case would have been set by receving the | 
|  | 495 | * FLOGI. | 
|  | 496 | */ | 
|  | 497 | fip->flogi_oxid = FC_XID_UNKNOWN; | 
|  | 498 | fc_fcoe_set_mac(fip->data_src_addr, fh->fh_s_id); | 
|  | 499 | return 0; | 
|  | 500 | default: | 
|  | 501 | if (fip->state != FIP_ST_ENABLED) | 
|  | 502 | goto drop; | 
|  | 503 | return 0; | 
|  | 504 | } | 
|  | 505 | if (fcoe_ctlr_encaps(fip, op, skb)) | 
|  | 506 | goto drop; | 
|  | 507 | fip->send(fip, skb); | 
|  | 508 | return -EINPROGRESS; | 
|  | 509 | drop: | 
|  | 510 | kfree_skb(skb); | 
|  | 511 | return -EINVAL; | 
|  | 512 | } | 
|  | 513 | EXPORT_SYMBOL(fcoe_ctlr_els_send); | 
|  | 514 |  | 
|  | 515 | /* | 
|  | 516 | * fcoe_ctlr_age_fcfs() - Reset and free all old FCFs for a controller. | 
|  | 517 | * @fip:	FCoE controller. | 
|  | 518 | * | 
|  | 519 | * Called with lock held. | 
|  | 520 | * | 
|  | 521 | * An FCF is considered old if we have missed three advertisements. | 
|  | 522 | * That is, there have been no valid advertisement from it for three | 
|  | 523 | * times its keep-alive period including fuzz. | 
|  | 524 | * | 
|  | 525 | * In addition, determine the time when an FCF selection can occur. | 
|  | 526 | */ | 
|  | 527 | static void fcoe_ctlr_age_fcfs(struct fcoe_ctlr *fip) | 
|  | 528 | { | 
|  | 529 | struct fcoe_fcf *fcf; | 
|  | 530 | struct fcoe_fcf *next; | 
|  | 531 | unsigned long sel_time = 0; | 
|  | 532 |  | 
|  | 533 | list_for_each_entry_safe(fcf, next, &fip->fcfs, list) { | 
|  | 534 | if (time_after(jiffies, fcf->time + fcf->fka_period * 3 + | 
|  | 535 | msecs_to_jiffies(FIP_FCF_FUZZ * 3))) { | 
|  | 536 | if (fip->sel_fcf == fcf) | 
|  | 537 | fip->sel_fcf = NULL; | 
|  | 538 | list_del(&fcf->list); | 
|  | 539 | WARN_ON(!fip->fcf_count); | 
|  | 540 | fip->fcf_count--; | 
|  | 541 | kfree(fcf); | 
|  | 542 | } else if (fcoe_ctlr_mtu_valid(fcf) && | 
|  | 543 | (!sel_time || time_before(sel_time, fcf->time))) { | 
|  | 544 | sel_time = fcf->time; | 
|  | 545 | } | 
|  | 546 | } | 
|  | 547 | if (sel_time) { | 
|  | 548 | sel_time += msecs_to_jiffies(FCOE_CTLR_START_DELAY); | 
|  | 549 | fip->sel_time = sel_time; | 
|  | 550 | if (time_before(sel_time, fip->timer.expires)) | 
|  | 551 | mod_timer(&fip->timer, sel_time); | 
|  | 552 | } else { | 
|  | 553 | fip->sel_time = 0; | 
|  | 554 | } | 
|  | 555 | } | 
|  | 556 |  | 
|  | 557 | /** | 
|  | 558 | * fcoe_ctlr_parse_adv() - Decode a FIP advertisement into a new FCF entry. | 
|  | 559 | * @skb:	received FIP advertisement frame | 
|  | 560 | * @fcf:	resulting FCF entry. | 
|  | 561 | * | 
|  | 562 | * Returns zero on a valid parsed advertisement, | 
|  | 563 | * otherwise returns non zero value. | 
|  | 564 | */ | 
|  | 565 | static int fcoe_ctlr_parse_adv(struct sk_buff *skb, struct fcoe_fcf *fcf) | 
|  | 566 | { | 
|  | 567 | struct fip_header *fiph; | 
|  | 568 | struct fip_desc *desc = NULL; | 
|  | 569 | struct fip_wwn_desc *wwn; | 
|  | 570 | struct fip_fab_desc *fab; | 
|  | 571 | struct fip_fka_desc *fka; | 
|  | 572 | unsigned long t; | 
|  | 573 | size_t rlen; | 
|  | 574 | size_t dlen; | 
|  | 575 |  | 
|  | 576 | memset(fcf, 0, sizeof(*fcf)); | 
|  | 577 | fcf->fka_period = msecs_to_jiffies(FCOE_CTLR_DEF_FKA); | 
|  | 578 |  | 
|  | 579 | fiph = (struct fip_header *)skb->data; | 
|  | 580 | fcf->flags = ntohs(fiph->fip_flags); | 
|  | 581 |  | 
|  | 582 | rlen = ntohs(fiph->fip_dl_len) * 4; | 
|  | 583 | if (rlen + sizeof(*fiph) > skb->len) | 
|  | 584 | return -EINVAL; | 
|  | 585 |  | 
|  | 586 | desc = (struct fip_desc *)(fiph + 1); | 
|  | 587 | while (rlen > 0) { | 
|  | 588 | dlen = desc->fip_dlen * FIP_BPW; | 
|  | 589 | if (dlen < sizeof(*desc) || dlen > rlen) | 
|  | 590 | return -EINVAL; | 
|  | 591 | switch (desc->fip_dtype) { | 
|  | 592 | case FIP_DT_PRI: | 
|  | 593 | if (dlen != sizeof(struct fip_pri_desc)) | 
|  | 594 | goto len_err; | 
|  | 595 | fcf->pri = ((struct fip_pri_desc *)desc)->fd_pri; | 
|  | 596 | break; | 
|  | 597 | case FIP_DT_MAC: | 
|  | 598 | if (dlen != sizeof(struct fip_mac_desc)) | 
|  | 599 | goto len_err; | 
|  | 600 | memcpy(fcf->fcf_mac, | 
|  | 601 | ((struct fip_mac_desc *)desc)->fd_mac, | 
|  | 602 | ETH_ALEN); | 
|  | 603 | if (!is_valid_ether_addr(fcf->fcf_mac)) { | 
|  | 604 | FIP_DBG("invalid MAC addr in FIP adv\n"); | 
|  | 605 | return -EINVAL; | 
|  | 606 | } | 
|  | 607 | break; | 
|  | 608 | case FIP_DT_NAME: | 
|  | 609 | if (dlen != sizeof(struct fip_wwn_desc)) | 
|  | 610 | goto len_err; | 
|  | 611 | wwn = (struct fip_wwn_desc *)desc; | 
|  | 612 | fcf->switch_name = get_unaligned_be64(&wwn->fd_wwn); | 
|  | 613 | break; | 
|  | 614 | case FIP_DT_FAB: | 
|  | 615 | if (dlen != sizeof(struct fip_fab_desc)) | 
|  | 616 | goto len_err; | 
|  | 617 | fab = (struct fip_fab_desc *)desc; | 
|  | 618 | fcf->fabric_name = get_unaligned_be64(&fab->fd_wwn); | 
|  | 619 | fcf->vfid = ntohs(fab->fd_vfid); | 
|  | 620 | fcf->fc_map = ntoh24(fab->fd_map); | 
|  | 621 | break; | 
|  | 622 | case FIP_DT_FKA: | 
|  | 623 | if (dlen != sizeof(struct fip_fka_desc)) | 
|  | 624 | goto len_err; | 
|  | 625 | fka = (struct fip_fka_desc *)desc; | 
|  | 626 | t = ntohl(fka->fd_fka_period); | 
|  | 627 | if (t >= FCOE_CTLR_MIN_FKA) | 
|  | 628 | fcf->fka_period = msecs_to_jiffies(t); | 
|  | 629 | break; | 
|  | 630 | case FIP_DT_MAP_OUI: | 
|  | 631 | case FIP_DT_FCOE_SIZE: | 
|  | 632 | case FIP_DT_FLOGI: | 
|  | 633 | case FIP_DT_FDISC: | 
|  | 634 | case FIP_DT_LOGO: | 
|  | 635 | case FIP_DT_ELP: | 
|  | 636 | default: | 
|  | 637 | FIP_DBG("unexpected descriptor type %x in FIP adv\n", | 
|  | 638 | desc->fip_dtype); | 
|  | 639 | /* standard says ignore unknown descriptors >= 128 */ | 
|  | 640 | if (desc->fip_dtype < FIP_DT_VENDOR_BASE) | 
|  | 641 | return -EINVAL; | 
|  | 642 | continue; | 
|  | 643 | } | 
|  | 644 | desc = (struct fip_desc *)((char *)desc + dlen); | 
|  | 645 | rlen -= dlen; | 
|  | 646 | } | 
|  | 647 | if (!fcf->fc_map || (fcf->fc_map & 0x10000)) | 
|  | 648 | return -EINVAL; | 
|  | 649 | if (!fcf->switch_name || !fcf->fabric_name) | 
|  | 650 | return -EINVAL; | 
|  | 651 | return 0; | 
|  | 652 |  | 
|  | 653 | len_err: | 
|  | 654 | FIP_DBG("FIP length error in descriptor type %x len %zu\n", | 
|  | 655 | desc->fip_dtype, dlen); | 
|  | 656 | return -EINVAL; | 
|  | 657 | } | 
|  | 658 |  | 
|  | 659 | /** | 
|  | 660 | * fcoe_ctlr_recv_adv() - Handle an incoming advertisement. | 
|  | 661 | * @fip:	FCoE controller. | 
|  | 662 | * @skb:	Received FIP packet. | 
|  | 663 | */ | 
|  | 664 | static void fcoe_ctlr_recv_adv(struct fcoe_ctlr *fip, struct sk_buff *skb) | 
|  | 665 | { | 
|  | 666 | struct fcoe_fcf *fcf; | 
|  | 667 | struct fcoe_fcf new; | 
|  | 668 | struct fcoe_fcf *found; | 
|  | 669 | unsigned long sol_tov = msecs_to_jiffies(FCOE_CTRL_SOL_TOV); | 
|  | 670 | int first = 0; | 
|  | 671 | int mtu_valid; | 
|  | 672 |  | 
|  | 673 | if (fcoe_ctlr_parse_adv(skb, &new)) | 
|  | 674 | return; | 
|  | 675 |  | 
|  | 676 | spin_lock_bh(&fip->lock); | 
|  | 677 | first = list_empty(&fip->fcfs); | 
|  | 678 | found = NULL; | 
|  | 679 | list_for_each_entry(fcf, &fip->fcfs, list) { | 
|  | 680 | if (fcf->switch_name == new.switch_name && | 
|  | 681 | fcf->fabric_name == new.fabric_name && | 
|  | 682 | fcf->fc_map == new.fc_map && | 
|  | 683 | compare_ether_addr(fcf->fcf_mac, new.fcf_mac) == 0) { | 
|  | 684 | found = fcf; | 
|  | 685 | break; | 
|  | 686 | } | 
|  | 687 | } | 
|  | 688 | if (!found) { | 
|  | 689 | if (fip->fcf_count >= FCOE_CTLR_FCF_LIMIT) | 
|  | 690 | goto out; | 
|  | 691 |  | 
|  | 692 | fcf = kmalloc(sizeof(*fcf), GFP_ATOMIC); | 
|  | 693 | if (!fcf) | 
|  | 694 | goto out; | 
|  | 695 |  | 
|  | 696 | fip->fcf_count++; | 
|  | 697 | memcpy(fcf, &new, sizeof(new)); | 
|  | 698 | list_add(&fcf->list, &fip->fcfs); | 
|  | 699 | } else { | 
|  | 700 | /* | 
|  | 701 | * Flags in advertisements are ignored once the FCF is | 
|  | 702 | * selected.  Flags in unsolicited advertisements are | 
|  | 703 | * ignored after a usable solicited advertisement | 
|  | 704 | * has been received. | 
|  | 705 | */ | 
|  | 706 | if (fcf == fip->sel_fcf) { | 
|  | 707 | fip->ctlr_ka_time -= fcf->fka_period; | 
|  | 708 | fip->ctlr_ka_time += new.fka_period; | 
|  | 709 | if (time_before(fip->ctlr_ka_time, fip->timer.expires)) | 
|  | 710 | mod_timer(&fip->timer, fip->ctlr_ka_time); | 
|  | 711 | } else if (!fcoe_ctlr_fcf_usable(fcf)) | 
|  | 712 | fcf->flags = new.flags; | 
|  | 713 | fcf->fka_period = new.fka_period; | 
|  | 714 | memcpy(fcf->fcf_mac, new.fcf_mac, ETH_ALEN); | 
|  | 715 | } | 
|  | 716 | mtu_valid = fcoe_ctlr_mtu_valid(fcf); | 
|  | 717 | fcf->time = jiffies; | 
|  | 718 | FIP_DBG_LVL(found ? 2 : 1, "%s FCF for fab %llx map %x val %d\n", | 
|  | 719 | found ? "old" : "new", | 
|  | 720 | fcf->fabric_name, fcf->fc_map, mtu_valid); | 
|  | 721 |  | 
|  | 722 | /* | 
|  | 723 | * If this advertisement is not solicited and our max receive size | 
|  | 724 | * hasn't been verified, send a solicited advertisement. | 
|  | 725 | */ | 
|  | 726 | if (!mtu_valid) | 
|  | 727 | fcoe_ctlr_solicit(fip, fcf); | 
|  | 728 |  | 
|  | 729 | /* | 
|  | 730 | * If its been a while since we did a solicit, and this is | 
|  | 731 | * the first advertisement we've received, do a multicast | 
|  | 732 | * solicitation to gather as many advertisements as we can | 
|  | 733 | * before selection occurs. | 
|  | 734 | */ | 
|  | 735 | if (first && time_after(jiffies, fip->sol_time + sol_tov)) | 
|  | 736 | fcoe_ctlr_solicit(fip, NULL); | 
|  | 737 |  | 
|  | 738 | /* | 
|  | 739 | * If this is the first validated FCF, note the time and | 
|  | 740 | * set a timer to trigger selection. | 
|  | 741 | */ | 
|  | 742 | if (mtu_valid && !fip->sel_time && fcoe_ctlr_fcf_usable(fcf)) { | 
|  | 743 | fip->sel_time = jiffies + | 
|  | 744 | msecs_to_jiffies(FCOE_CTLR_START_DELAY); | 
|  | 745 | if (!timer_pending(&fip->timer) || | 
|  | 746 | time_before(fip->sel_time, fip->timer.expires)) | 
|  | 747 | mod_timer(&fip->timer, fip->sel_time); | 
|  | 748 | } | 
|  | 749 | out: | 
|  | 750 | spin_unlock_bh(&fip->lock); | 
|  | 751 | } | 
|  | 752 |  | 
|  | 753 | /** | 
|  | 754 | * fcoe_ctlr_recv_els() - Handle an incoming FIP-encapsulated ELS frame. | 
|  | 755 | * @fip:	FCoE controller. | 
|  | 756 | * @skb:	Received FIP packet. | 
|  | 757 | */ | 
|  | 758 | static void fcoe_ctlr_recv_els(struct fcoe_ctlr *fip, struct sk_buff *skb) | 
|  | 759 | { | 
|  | 760 | struct fc_lport *lp = fip->lp; | 
|  | 761 | struct fip_header *fiph; | 
|  | 762 | struct fc_frame *fp; | 
|  | 763 | struct fc_frame_header *fh = NULL; | 
|  | 764 | struct fip_desc *desc; | 
|  | 765 | struct fip_encaps *els; | 
|  | 766 | struct fcoe_dev_stats *stats; | 
|  | 767 | enum fip_desc_type els_dtype = 0; | 
|  | 768 | u8 els_op; | 
|  | 769 | u8 sub; | 
|  | 770 | u8 granted_mac[ETH_ALEN] = { 0 }; | 
|  | 771 | size_t els_len = 0; | 
|  | 772 | size_t rlen; | 
|  | 773 | size_t dlen; | 
|  | 774 |  | 
|  | 775 | fiph = (struct fip_header *)skb->data; | 
|  | 776 | sub = fiph->fip_subcode; | 
|  | 777 | if (sub != FIP_SC_REQ && sub != FIP_SC_REP) | 
|  | 778 | goto drop; | 
|  | 779 |  | 
|  | 780 | rlen = ntohs(fiph->fip_dl_len) * 4; | 
|  | 781 | if (rlen + sizeof(*fiph) > skb->len) | 
|  | 782 | goto drop; | 
|  | 783 |  | 
|  | 784 | desc = (struct fip_desc *)(fiph + 1); | 
|  | 785 | while (rlen > 0) { | 
|  | 786 | dlen = desc->fip_dlen * FIP_BPW; | 
|  | 787 | if (dlen < sizeof(*desc) || dlen > rlen) | 
|  | 788 | goto drop; | 
|  | 789 | switch (desc->fip_dtype) { | 
|  | 790 | case FIP_DT_MAC: | 
|  | 791 | if (dlen != sizeof(struct fip_mac_desc)) | 
|  | 792 | goto len_err; | 
|  | 793 | memcpy(granted_mac, | 
|  | 794 | ((struct fip_mac_desc *)desc)->fd_mac, | 
|  | 795 | ETH_ALEN); | 
|  | 796 | if (!is_valid_ether_addr(granted_mac)) { | 
|  | 797 | FIP_DBG("invalid MAC addrs in FIP ELS\n"); | 
|  | 798 | goto drop; | 
|  | 799 | } | 
|  | 800 | break; | 
|  | 801 | case FIP_DT_FLOGI: | 
|  | 802 | case FIP_DT_FDISC: | 
|  | 803 | case FIP_DT_LOGO: | 
|  | 804 | case FIP_DT_ELP: | 
|  | 805 | if (fh) | 
|  | 806 | goto drop; | 
|  | 807 | if (dlen < sizeof(*els) + sizeof(*fh) + 1) | 
|  | 808 | goto len_err; | 
|  | 809 | els_len = dlen - sizeof(*els); | 
|  | 810 | els = (struct fip_encaps *)desc; | 
|  | 811 | fh = (struct fc_frame_header *)(els + 1); | 
|  | 812 | els_dtype = desc->fip_dtype; | 
|  | 813 | break; | 
|  | 814 | default: | 
|  | 815 | FIP_DBG("unexpected descriptor type %x " | 
|  | 816 | "in FIP adv\n", desc->fip_dtype); | 
|  | 817 | /* standard says ignore unknown descriptors >= 128 */ | 
|  | 818 | if (desc->fip_dtype < FIP_DT_VENDOR_BASE) | 
|  | 819 | goto drop; | 
|  | 820 | continue; | 
|  | 821 | } | 
|  | 822 | desc = (struct fip_desc *)((char *)desc + dlen); | 
|  | 823 | rlen -= dlen; | 
|  | 824 | } | 
|  | 825 |  | 
|  | 826 | if (!fh) | 
|  | 827 | goto drop; | 
|  | 828 | els_op = *(u8 *)(fh + 1); | 
|  | 829 |  | 
|  | 830 | if (els_dtype == FIP_DT_FLOGI && sub == FIP_SC_REP && | 
|  | 831 | fip->flogi_oxid == ntohs(fh->fh_ox_id) && | 
|  | 832 | els_op == ELS_LS_ACC && is_valid_ether_addr(granted_mac)) { | 
|  | 833 | fip->flogi_oxid = FC_XID_UNKNOWN; | 
|  | 834 | fip->update_mac(fip, fip->data_src_addr, granted_mac); | 
|  | 835 | memcpy(fip->data_src_addr, granted_mac, ETH_ALEN); | 
|  | 836 | } | 
|  | 837 |  | 
|  | 838 | /* | 
|  | 839 | * Convert skb into an fc_frame containing only the ELS. | 
|  | 840 | */ | 
|  | 841 | skb_pull(skb, (u8 *)fh - skb->data); | 
|  | 842 | skb_trim(skb, els_len); | 
|  | 843 | fp = (struct fc_frame *)skb; | 
|  | 844 | fc_frame_init(fp); | 
|  | 845 | fr_sof(fp) = FC_SOF_I3; | 
|  | 846 | fr_eof(fp) = FC_EOF_T; | 
|  | 847 | fr_dev(fp) = lp; | 
|  | 848 |  | 
|  | 849 | stats = fc_lport_get_stats(lp); | 
|  | 850 | stats->RxFrames++; | 
|  | 851 | stats->RxWords += skb->len / FIP_BPW; | 
|  | 852 |  | 
|  | 853 | fc_exch_recv(lp, lp->emp, fp); | 
|  | 854 | return; | 
|  | 855 |  | 
|  | 856 | len_err: | 
|  | 857 | FIP_DBG("FIP length error in descriptor type %x len %zu\n", | 
|  | 858 | desc->fip_dtype, dlen); | 
|  | 859 | drop: | 
|  | 860 | kfree_skb(skb); | 
|  | 861 | } | 
|  | 862 |  | 
|  | 863 | /** | 
|  | 864 | * fcoe_ctlr_recv_els() - Handle an incoming link reset frame. | 
|  | 865 | * @fip:	FCoE controller. | 
|  | 866 | * @fh:		Received FIP header. | 
|  | 867 | * | 
|  | 868 | * There may be multiple VN_Port descriptors. | 
|  | 869 | * The overall length has already been checked. | 
|  | 870 | */ | 
|  | 871 | static void fcoe_ctlr_recv_clr_vlink(struct fcoe_ctlr *fip, | 
|  | 872 | struct fip_header *fh) | 
|  | 873 | { | 
|  | 874 | struct fip_desc *desc; | 
|  | 875 | struct fip_mac_desc *mp; | 
|  | 876 | struct fip_wwn_desc *wp; | 
|  | 877 | struct fip_vn_desc *vp; | 
|  | 878 | size_t rlen; | 
|  | 879 | size_t dlen; | 
|  | 880 | struct fcoe_fcf *fcf = fip->sel_fcf; | 
|  | 881 | struct fc_lport *lp = fip->lp; | 
|  | 882 | u32	desc_mask; | 
|  | 883 |  | 
|  | 884 | FIP_DBG("Clear Virtual Link received\n"); | 
|  | 885 | if (!fcf) | 
|  | 886 | return; | 
|  | 887 | if (!fcf || !fc_host_port_id(lp->host)) | 
|  | 888 | return; | 
|  | 889 |  | 
|  | 890 | /* | 
|  | 891 | * mask of required descriptors.  Validating each one clears its bit. | 
|  | 892 | */ | 
|  | 893 | desc_mask = BIT(FIP_DT_MAC) | BIT(FIP_DT_NAME) | BIT(FIP_DT_VN_ID); | 
|  | 894 |  | 
|  | 895 | rlen = ntohs(fh->fip_dl_len) * FIP_BPW; | 
|  | 896 | desc = (struct fip_desc *)(fh + 1); | 
|  | 897 | while (rlen >= sizeof(*desc)) { | 
|  | 898 | dlen = desc->fip_dlen * FIP_BPW; | 
|  | 899 | if (dlen > rlen) | 
|  | 900 | return; | 
|  | 901 | switch (desc->fip_dtype) { | 
|  | 902 | case FIP_DT_MAC: | 
|  | 903 | mp = (struct fip_mac_desc *)desc; | 
|  | 904 | if (dlen < sizeof(*mp)) | 
|  | 905 | return; | 
|  | 906 | if (compare_ether_addr(mp->fd_mac, fcf->fcf_mac)) | 
|  | 907 | return; | 
|  | 908 | desc_mask &= ~BIT(FIP_DT_MAC); | 
|  | 909 | break; | 
|  | 910 | case FIP_DT_NAME: | 
|  | 911 | wp = (struct fip_wwn_desc *)desc; | 
|  | 912 | if (dlen < sizeof(*wp)) | 
|  | 913 | return; | 
|  | 914 | if (get_unaligned_be64(&wp->fd_wwn) != fcf->switch_name) | 
|  | 915 | return; | 
|  | 916 | desc_mask &= ~BIT(FIP_DT_NAME); | 
|  | 917 | break; | 
|  | 918 | case FIP_DT_VN_ID: | 
|  | 919 | vp = (struct fip_vn_desc *)desc; | 
|  | 920 | if (dlen < sizeof(*vp)) | 
|  | 921 | return; | 
|  | 922 | if (compare_ether_addr(vp->fd_mac, | 
|  | 923 | fip->data_src_addr) == 0 && | 
|  | 924 | get_unaligned_be64(&vp->fd_wwpn) == lp->wwpn && | 
|  | 925 | ntoh24(vp->fd_fc_id) == fc_host_port_id(lp->host)) | 
|  | 926 | desc_mask &= ~BIT(FIP_DT_VN_ID); | 
|  | 927 | break; | 
|  | 928 | default: | 
|  | 929 | /* standard says ignore unknown descriptors >= 128 */ | 
|  | 930 | if (desc->fip_dtype < FIP_DT_VENDOR_BASE) | 
|  | 931 | return; | 
|  | 932 | break; | 
|  | 933 | } | 
|  | 934 | desc = (struct fip_desc *)((char *)desc + dlen); | 
|  | 935 | rlen -= dlen; | 
|  | 936 | } | 
|  | 937 |  | 
|  | 938 | /* | 
|  | 939 | * reset only if all required descriptors were present and valid. | 
|  | 940 | */ | 
|  | 941 | if (desc_mask) { | 
|  | 942 | FIP_DBG("missing descriptors mask %x\n", desc_mask); | 
|  | 943 | } else { | 
|  | 944 | FIP_DBG("performing Clear Virtual Link\n"); | 
|  | 945 | fcoe_ctlr_reset(fip, FIP_ST_ENABLED); | 
|  | 946 | } | 
|  | 947 | } | 
|  | 948 |  | 
|  | 949 | /** | 
|  | 950 | * fcoe_ctlr_recv() - Receive a FIP frame. | 
|  | 951 | * @fip:	FCoE controller. | 
|  | 952 | * @skb:	Received FIP packet. | 
|  | 953 | * | 
|  | 954 | * This is called from NET_RX_SOFTIRQ. | 
|  | 955 | */ | 
|  | 956 | void fcoe_ctlr_recv(struct fcoe_ctlr *fip, struct sk_buff *skb) | 
|  | 957 | { | 
|  | 958 | spin_lock_bh(&fip->fip_recv_list.lock); | 
|  | 959 | __skb_queue_tail(&fip->fip_recv_list, skb); | 
|  | 960 | spin_unlock_bh(&fip->fip_recv_list.lock); | 
|  | 961 | schedule_work(&fip->recv_work); | 
|  | 962 | } | 
|  | 963 | EXPORT_SYMBOL(fcoe_ctlr_recv); | 
|  | 964 |  | 
|  | 965 | /** | 
|  | 966 | * fcoe_ctlr_recv_handler() - Receive a FIP frame. | 
|  | 967 | * @fip:	FCoE controller. | 
|  | 968 | * @skb:	Received FIP packet. | 
|  | 969 | * | 
|  | 970 | * Returns non-zero if the frame is dropped. | 
|  | 971 | */ | 
|  | 972 | static int fcoe_ctlr_recv_handler(struct fcoe_ctlr *fip, struct sk_buff *skb) | 
|  | 973 | { | 
|  | 974 | struct fip_header *fiph; | 
|  | 975 | struct ethhdr *eh; | 
|  | 976 | enum fip_state state; | 
|  | 977 | u16 op; | 
|  | 978 | u8 sub; | 
|  | 979 |  | 
|  | 980 | if (skb_linearize(skb)) | 
|  | 981 | goto drop; | 
|  | 982 | if (skb->len < sizeof(*fiph)) | 
|  | 983 | goto drop; | 
|  | 984 | eh = eth_hdr(skb); | 
|  | 985 | if (compare_ether_addr(eh->h_dest, fip->ctl_src_addr) && | 
|  | 986 | compare_ether_addr(eh->h_dest, FIP_ALL_ENODE_MACS)) | 
|  | 987 | goto drop; | 
|  | 988 | fiph = (struct fip_header *)skb->data; | 
|  | 989 | op = ntohs(fiph->fip_op); | 
|  | 990 | sub = fiph->fip_subcode; | 
|  | 991 |  | 
|  | 992 | FIP_DBG_LVL(2, "ver %x op %x/%x dl %x fl %x\n", | 
|  | 993 | FIP_VER_DECAPS(fiph->fip_ver), op, sub, | 
|  | 994 | ntohs(fiph->fip_dl_len), ntohs(fiph->fip_flags)); | 
|  | 995 |  | 
|  | 996 | if (FIP_VER_DECAPS(fiph->fip_ver) != FIP_VER) | 
|  | 997 | goto drop; | 
|  | 998 | if (ntohs(fiph->fip_dl_len) * FIP_BPW + sizeof(*fiph) > skb->len) | 
|  | 999 | goto drop; | 
|  | 1000 |  | 
|  | 1001 | spin_lock_bh(&fip->lock); | 
|  | 1002 | state = fip->state; | 
|  | 1003 | if (state == FIP_ST_AUTO) { | 
|  | 1004 | fip->map_dest = 0; | 
|  | 1005 | fip->state = FIP_ST_ENABLED; | 
|  | 1006 | state = FIP_ST_ENABLED; | 
|  | 1007 | FIP_DBG("using FIP mode\n"); | 
|  | 1008 | } | 
|  | 1009 | spin_unlock_bh(&fip->lock); | 
|  | 1010 | if (state != FIP_ST_ENABLED) | 
|  | 1011 | goto drop; | 
|  | 1012 |  | 
|  | 1013 | if (op == FIP_OP_LS) { | 
|  | 1014 | fcoe_ctlr_recv_els(fip, skb);	/* consumes skb */ | 
|  | 1015 | return 0; | 
|  | 1016 | } | 
|  | 1017 | if (op == FIP_OP_DISC && sub == FIP_SC_ADV) | 
|  | 1018 | fcoe_ctlr_recv_adv(fip, skb); | 
|  | 1019 | else if (op == FIP_OP_CTRL && sub == FIP_SC_CLR_VLINK) | 
|  | 1020 | fcoe_ctlr_recv_clr_vlink(fip, fiph); | 
|  | 1021 | kfree_skb(skb); | 
|  | 1022 | return 0; | 
|  | 1023 | drop: | 
|  | 1024 | kfree_skb(skb); | 
|  | 1025 | return -1; | 
|  | 1026 | } | 
|  | 1027 |  | 
|  | 1028 | /** | 
|  | 1029 | * fcoe_ctlr_select() - Select the best FCF, if possible. | 
|  | 1030 | * @fip:	FCoE controller. | 
|  | 1031 | * | 
|  | 1032 | * If there are conflicting advertisements, no FCF can be chosen. | 
|  | 1033 | * | 
|  | 1034 | * Called with lock held. | 
|  | 1035 | */ | 
|  | 1036 | static void fcoe_ctlr_select(struct fcoe_ctlr *fip) | 
|  | 1037 | { | 
|  | 1038 | struct fcoe_fcf *fcf; | 
|  | 1039 | struct fcoe_fcf *best = NULL; | 
|  | 1040 |  | 
|  | 1041 | list_for_each_entry(fcf, &fip->fcfs, list) { | 
|  | 1042 | FIP_DBG("consider FCF for fab %llx VFID %d map %x val %d\n", | 
|  | 1043 | fcf->fabric_name, fcf->vfid, | 
|  | 1044 | fcf->fc_map, fcoe_ctlr_mtu_valid(fcf)); | 
|  | 1045 | if (!fcoe_ctlr_fcf_usable(fcf)) { | 
|  | 1046 | FIP_DBG("FCF for fab %llx map %x %svalid %savailable\n", | 
|  | 1047 | fcf->fabric_name, fcf->fc_map, | 
|  | 1048 | (fcf->flags & FIP_FL_SOL) ? "" : "in", | 
|  | 1049 | (fcf->flags & FIP_FL_AVAIL) ? "" : "un"); | 
|  | 1050 | continue; | 
|  | 1051 | } | 
|  | 1052 | if (!best) { | 
|  | 1053 | best = fcf; | 
|  | 1054 | continue; | 
|  | 1055 | } | 
|  | 1056 | if (fcf->fabric_name != best->fabric_name || | 
|  | 1057 | fcf->vfid != best->vfid || | 
|  | 1058 | fcf->fc_map != best->fc_map) { | 
|  | 1059 | FIP_DBG("conflicting fabric, VFID, or FC-MAP\n"); | 
|  | 1060 | return; | 
|  | 1061 | } | 
|  | 1062 | if (fcf->pri < best->pri) | 
|  | 1063 | best = fcf; | 
|  | 1064 | } | 
|  | 1065 | fip->sel_fcf = best; | 
|  | 1066 | } | 
|  | 1067 |  | 
|  | 1068 | /** | 
|  | 1069 | * fcoe_ctlr_timeout() - FIP timer function. | 
|  | 1070 | * @arg:	&fcoe_ctlr pointer. | 
|  | 1071 | * | 
|  | 1072 | * Ages FCFs.  Triggers FCF selection if possible.  Sends keep-alives. | 
|  | 1073 | */ | 
|  | 1074 | static void fcoe_ctlr_timeout(unsigned long arg) | 
|  | 1075 | { | 
|  | 1076 | struct fcoe_ctlr *fip = (struct fcoe_ctlr *)arg; | 
|  | 1077 | struct fcoe_fcf *sel; | 
|  | 1078 | struct fcoe_fcf *fcf; | 
|  | 1079 | unsigned long next_timer = jiffies + msecs_to_jiffies(FIP_VN_KA_PERIOD); | 
|  | 1080 | DECLARE_MAC_BUF(buf); | 
|  | 1081 | u8 send_ctlr_ka; | 
|  | 1082 | u8 send_port_ka; | 
|  | 1083 |  | 
|  | 1084 | spin_lock_bh(&fip->lock); | 
|  | 1085 | if (fip->state == FIP_ST_DISABLED) { | 
|  | 1086 | spin_unlock_bh(&fip->lock); | 
|  | 1087 | return; | 
|  | 1088 | } | 
|  | 1089 |  | 
|  | 1090 | fcf = fip->sel_fcf; | 
|  | 1091 | fcoe_ctlr_age_fcfs(fip); | 
|  | 1092 |  | 
|  | 1093 | sel = fip->sel_fcf; | 
|  | 1094 | if (!sel && fip->sel_time && time_after_eq(jiffies, fip->sel_time)) { | 
|  | 1095 | fcoe_ctlr_select(fip); | 
|  | 1096 | sel = fip->sel_fcf; | 
|  | 1097 | fip->sel_time = 0; | 
|  | 1098 | } | 
|  | 1099 |  | 
|  | 1100 | if (sel != fcf) { | 
|  | 1101 | fcf = sel;		/* the old FCF may have been freed */ | 
|  | 1102 | if (sel) { | 
|  | 1103 | printk(KERN_INFO "host%d: FIP selected " | 
|  | 1104 | "Fibre-Channel Forwarder MAC %s\n", | 
|  | 1105 | fip->lp->host->host_no, | 
|  | 1106 | print_mac(buf, sel->fcf_mac)); | 
|  | 1107 | memcpy(fip->dest_addr, sel->fcf_mac, ETH_ALEN); | 
|  | 1108 | fip->port_ka_time = jiffies + | 
|  | 1109 | msecs_to_jiffies(FIP_VN_KA_PERIOD); | 
|  | 1110 | fip->ctlr_ka_time = jiffies + sel->fka_period; | 
|  | 1111 | fip->link = 1; | 
|  | 1112 | } else { | 
|  | 1113 | printk(KERN_NOTICE "host%d: " | 
|  | 1114 | "FIP Fibre-Channel Forwarder timed out.  " | 
|  | 1115 | "Starting FCF discovery.\n", | 
|  | 1116 | fip->lp->host->host_no); | 
|  | 1117 | fip->link = 0; | 
|  | 1118 | } | 
|  | 1119 | schedule_work(&fip->link_work); | 
|  | 1120 | } | 
|  | 1121 |  | 
|  | 1122 | send_ctlr_ka = 0; | 
|  | 1123 | send_port_ka = 0; | 
|  | 1124 | if (sel) { | 
|  | 1125 | if (time_after_eq(jiffies, fip->ctlr_ka_time)) { | 
|  | 1126 | fip->ctlr_ka_time = jiffies + sel->fka_period; | 
|  | 1127 | send_ctlr_ka = 1; | 
|  | 1128 | } | 
|  | 1129 | if (time_after(next_timer, fip->ctlr_ka_time)) | 
|  | 1130 | next_timer = fip->ctlr_ka_time; | 
|  | 1131 |  | 
|  | 1132 | if (time_after_eq(jiffies, fip->port_ka_time)) { | 
|  | 1133 | fip->port_ka_time += jiffies + | 
|  | 1134 | msecs_to_jiffies(FIP_VN_KA_PERIOD); | 
|  | 1135 | send_port_ka = 1; | 
|  | 1136 | } | 
|  | 1137 | if (time_after(next_timer, fip->port_ka_time)) | 
|  | 1138 | next_timer = fip->port_ka_time; | 
|  | 1139 | mod_timer(&fip->timer, next_timer); | 
|  | 1140 | } else if (fip->sel_time) { | 
|  | 1141 | next_timer = fip->sel_time + | 
|  | 1142 | msecs_to_jiffies(FCOE_CTLR_START_DELAY); | 
|  | 1143 | mod_timer(&fip->timer, next_timer); | 
|  | 1144 | } | 
|  | 1145 | spin_unlock_bh(&fip->lock); | 
|  | 1146 |  | 
|  | 1147 | if (send_ctlr_ka) | 
|  | 1148 | fcoe_ctlr_send_keep_alive(fip, 0, fip->ctl_src_addr); | 
|  | 1149 | if (send_port_ka) | 
|  | 1150 | fcoe_ctlr_send_keep_alive(fip, 1, fip->data_src_addr); | 
|  | 1151 | } | 
|  | 1152 |  | 
|  | 1153 | /** | 
|  | 1154 | * fcoe_ctlr_link_work() - worker thread function for link changes. | 
|  | 1155 | * @work:	pointer to link_work member inside &fcoe_ctlr. | 
|  | 1156 | * | 
|  | 1157 | * See if the link status has changed and if so, report it. | 
|  | 1158 | * | 
|  | 1159 | * This is here because fc_linkup() and fc_linkdown() must not | 
|  | 1160 | * be called from the timer directly, since they use a mutex. | 
|  | 1161 | */ | 
|  | 1162 | static void fcoe_ctlr_link_work(struct work_struct *work) | 
|  | 1163 | { | 
|  | 1164 | struct fcoe_ctlr *fip; | 
|  | 1165 | int link; | 
|  | 1166 | int last_link; | 
|  | 1167 |  | 
|  | 1168 | fip = container_of(work, struct fcoe_ctlr, link_work); | 
|  | 1169 | spin_lock_bh(&fip->lock); | 
|  | 1170 | last_link = fip->last_link; | 
|  | 1171 | link = fip->link; | 
|  | 1172 | fip->last_link = link; | 
|  | 1173 | spin_unlock_bh(&fip->lock); | 
|  | 1174 |  | 
|  | 1175 | if (last_link != link) { | 
|  | 1176 | if (link) | 
|  | 1177 | fc_linkup(fip->lp); | 
|  | 1178 | else | 
|  | 1179 | fcoe_ctlr_reset(fip, FIP_ST_LINK_WAIT); | 
|  | 1180 | } | 
|  | 1181 | } | 
|  | 1182 |  | 
|  | 1183 | /** | 
|  | 1184 | * fcoe_ctlr_recv_work() - Worker thread function for receiving FIP frames. | 
|  | 1185 | * @recv_work:	pointer to recv_work member inside &fcoe_ctlr. | 
|  | 1186 | */ | 
|  | 1187 | static void fcoe_ctlr_recv_work(struct work_struct *recv_work) | 
|  | 1188 | { | 
|  | 1189 | struct fcoe_ctlr *fip; | 
|  | 1190 | struct sk_buff *skb; | 
|  | 1191 |  | 
|  | 1192 | fip = container_of(recv_work, struct fcoe_ctlr, recv_work); | 
|  | 1193 | spin_lock_bh(&fip->fip_recv_list.lock); | 
|  | 1194 | while ((skb = __skb_dequeue(&fip->fip_recv_list))) { | 
|  | 1195 | spin_unlock_bh(&fip->fip_recv_list.lock); | 
|  | 1196 | fcoe_ctlr_recv_handler(fip, skb); | 
|  | 1197 | spin_lock_bh(&fip->fip_recv_list.lock); | 
|  | 1198 | } | 
|  | 1199 | spin_unlock_bh(&fip->fip_recv_list.lock); | 
|  | 1200 | } | 
|  | 1201 |  | 
|  | 1202 | /** | 
|  | 1203 | * fcoe_ctlr_recv_flogi() - snoop Pre-FIP receipt of FLOGI response or request. | 
|  | 1204 | * @fip:	FCoE controller. | 
|  | 1205 | * @fp:		FC frame. | 
|  | 1206 | * @sa:		Ethernet source MAC address from received FCoE frame. | 
|  | 1207 | * | 
|  | 1208 | * Snoop potential response to FLOGI or even incoming FLOGI. | 
|  | 1209 | * | 
|  | 1210 | * The caller has checked that we are waiting for login as indicated | 
|  | 1211 | * by fip->flogi_oxid != FC_XID_UNKNOWN. | 
|  | 1212 | * | 
|  | 1213 | * The caller is responsible for freeing the frame. | 
|  | 1214 | * | 
|  | 1215 | * Return non-zero if the frame should not be delivered to libfc. | 
|  | 1216 | */ | 
|  | 1217 | int fcoe_ctlr_recv_flogi(struct fcoe_ctlr *fip, struct fc_frame *fp, u8 *sa) | 
|  | 1218 | { | 
|  | 1219 | struct fc_frame_header *fh; | 
|  | 1220 | u8 op; | 
|  | 1221 | u8 mac[ETH_ALEN]; | 
|  | 1222 |  | 
|  | 1223 | fh = fc_frame_header_get(fp); | 
|  | 1224 | if (fh->fh_type != FC_TYPE_ELS) | 
|  | 1225 | return 0; | 
|  | 1226 |  | 
|  | 1227 | op = fc_frame_payload_op(fp); | 
|  | 1228 | if (op == ELS_LS_ACC && fh->fh_r_ctl == FC_RCTL_ELS_REP && | 
|  | 1229 | fip->flogi_oxid == ntohs(fh->fh_ox_id)) { | 
|  | 1230 |  | 
|  | 1231 | spin_lock_bh(&fip->lock); | 
|  | 1232 | if (fip->state != FIP_ST_AUTO && fip->state != FIP_ST_NON_FIP) { | 
|  | 1233 | spin_unlock_bh(&fip->lock); | 
|  | 1234 | return -EINVAL; | 
|  | 1235 | } | 
|  | 1236 | fip->state = FIP_ST_NON_FIP; | 
|  | 1237 | FIP_DBG("received FLOGI LS_ACC using non-FIP mode\n"); | 
|  | 1238 |  | 
|  | 1239 | /* | 
|  | 1240 | * FLOGI accepted. | 
|  | 1241 | * If the src mac addr is FC_OUI-based, then we mark the | 
|  | 1242 | * address_mode flag to use FC_OUI-based Ethernet DA. | 
|  | 1243 | * Otherwise we use the FCoE gateway addr | 
|  | 1244 | */ | 
|  | 1245 | if (!compare_ether_addr(sa, (u8[6])FC_FCOE_FLOGI_MAC)) { | 
|  | 1246 | fip->map_dest = 1; | 
|  | 1247 | } else { | 
|  | 1248 | memcpy(fip->dest_addr, sa, ETH_ALEN); | 
|  | 1249 | fip->map_dest = 0; | 
|  | 1250 | } | 
|  | 1251 | fip->flogi_oxid = FC_XID_UNKNOWN; | 
|  | 1252 | memcpy(mac, fip->data_src_addr, ETH_ALEN); | 
|  | 1253 | fc_fcoe_set_mac(fip->data_src_addr, fh->fh_d_id); | 
|  | 1254 | spin_unlock_bh(&fip->lock); | 
|  | 1255 |  | 
|  | 1256 | fip->update_mac(fip, mac, fip->data_src_addr); | 
|  | 1257 | } else if (op == ELS_FLOGI && fh->fh_r_ctl == FC_RCTL_ELS_REQ && sa) { | 
|  | 1258 | /* | 
|  | 1259 | * Save source MAC for point-to-point responses. | 
|  | 1260 | */ | 
|  | 1261 | spin_lock_bh(&fip->lock); | 
|  | 1262 | if (fip->state == FIP_ST_AUTO || fip->state == FIP_ST_NON_FIP) { | 
|  | 1263 | memcpy(fip->dest_addr, sa, ETH_ALEN); | 
|  | 1264 | fip->map_dest = 0; | 
|  | 1265 | if (fip->state == FIP_ST_NON_FIP) | 
|  | 1266 | FIP_DBG("received FLOGI REQ, " | 
|  | 1267 | "using non-FIP mode\n"); | 
|  | 1268 | fip->state = FIP_ST_NON_FIP; | 
|  | 1269 | } | 
|  | 1270 | spin_unlock_bh(&fip->lock); | 
|  | 1271 | } | 
|  | 1272 | return 0; | 
|  | 1273 | } | 
|  | 1274 | EXPORT_SYMBOL(fcoe_ctlr_recv_flogi); | 
|  | 1275 |  | 
| Vasu Dev | 5e80f7f | 2009-03-17 11:42:18 -0700 | [diff] [blame] | 1276 | /** | 
|  | 1277 | * fcoe_wwn_from_mac() - Converts 48-bit IEEE MAC address to 64-bit FC WWN. | 
|  | 1278 | * @mac: mac address | 
|  | 1279 | * @scheme: check port | 
|  | 1280 | * @port: port indicator for converting | 
|  | 1281 | * | 
|  | 1282 | * Returns: u64 fc world wide name | 
|  | 1283 | */ | 
|  | 1284 | u64 fcoe_wwn_from_mac(unsigned char mac[MAX_ADDR_LEN], | 
|  | 1285 | unsigned int scheme, unsigned int port) | 
|  | 1286 | { | 
|  | 1287 | u64 wwn; | 
|  | 1288 | u64 host_mac; | 
|  | 1289 |  | 
|  | 1290 | /* The MAC is in NO, so flip only the low 48 bits */ | 
|  | 1291 | host_mac = ((u64) mac[0] << 40) | | 
|  | 1292 | ((u64) mac[1] << 32) | | 
|  | 1293 | ((u64) mac[2] << 24) | | 
|  | 1294 | ((u64) mac[3] << 16) | | 
|  | 1295 | ((u64) mac[4] << 8) | | 
|  | 1296 | (u64) mac[5]; | 
|  | 1297 |  | 
|  | 1298 | WARN_ON(host_mac >= (1ULL << 48)); | 
|  | 1299 | wwn = host_mac | ((u64) scheme << 60); | 
|  | 1300 | switch (scheme) { | 
|  | 1301 | case 1: | 
|  | 1302 | WARN_ON(port != 0); | 
|  | 1303 | break; | 
|  | 1304 | case 2: | 
|  | 1305 | WARN_ON(port >= 0xfff); | 
|  | 1306 | wwn |= (u64) port << 48; | 
|  | 1307 | break; | 
|  | 1308 | default: | 
|  | 1309 | WARN_ON(1); | 
|  | 1310 | break; | 
|  | 1311 | } | 
|  | 1312 |  | 
|  | 1313 | return wwn; | 
|  | 1314 | } | 
|  | 1315 | EXPORT_SYMBOL_GPL(fcoe_wwn_from_mac); | 
|  | 1316 |  | 
|  | 1317 | /** | 
|  | 1318 | * fcoe_libfc_config() - sets up libfc related properties for lport | 
|  | 1319 | * @lp: ptr to the fc_lport | 
|  | 1320 | * @tt: libfc function template | 
|  | 1321 | * | 
|  | 1322 | * Returns : 0 for success | 
|  | 1323 | */ | 
|  | 1324 | int fcoe_libfc_config(struct fc_lport *lp, struct libfc_function_template *tt) | 
|  | 1325 | { | 
|  | 1326 | /* Set the function pointers set by the LLDD */ | 
|  | 1327 | memcpy(&lp->tt, tt, sizeof(*tt)); | 
|  | 1328 | if (fc_fcp_init(lp)) | 
|  | 1329 | return -ENOMEM; | 
|  | 1330 | fc_exch_init(lp); | 
|  | 1331 | fc_elsct_init(lp); | 
|  | 1332 | fc_lport_init(lp); | 
|  | 1333 | fc_rport_init(lp); | 
|  | 1334 | fc_disc_init(lp); | 
|  | 1335 |  | 
|  | 1336 | return 0; | 
|  | 1337 | } | 
|  | 1338 | EXPORT_SYMBOL_GPL(fcoe_libfc_config); |