| /* |
| * Copyright 2008 Cisco Systems, Inc. All rights reserved. |
| * Copyright 2007 Nuova Systems, Inc. All rights reserved. |
| * |
| * This program is free software; you may redistribute it and/or modify |
| * it under the terms of the GNU General Public License as published by |
| * the Free Software Foundation; version 2 of the License. |
| * |
| * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, |
| * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF |
| * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND |
| * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS |
| * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN |
| * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN |
| * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE |
| * SOFTWARE. |
| */ |
| #include <linux/module.h> |
| #include <linux/mempool.h> |
| #include <linux/string.h> |
| #include <linux/errno.h> |
| #include <linux/init.h> |
| #include <linux/pci.h> |
| #include <linux/skbuff.h> |
| #include <linux/interrupt.h> |
| #include <linux/spinlock.h> |
| #include <linux/workqueue.h> |
| #include <scsi/scsi_host.h> |
| #include <scsi/scsi_transport.h> |
| #include <scsi/scsi_transport_fc.h> |
| #include <scsi/scsi_tcq.h> |
| #include <scsi/libfc.h> |
| #include <scsi/fc_frame.h> |
| |
| #include "vnic_dev.h" |
| #include "vnic_intr.h" |
| #include "vnic_stats.h" |
| #include "fnic_io.h" |
| #include "fnic.h" |
| |
| #define PCI_DEVICE_ID_CISCO_FNIC 0x0045 |
| |
| /* Timer to poll notification area for events. Used for MSI interrupts */ |
| #define FNIC_NOTIFY_TIMER_PERIOD (2 * HZ) |
| |
| static struct kmem_cache *fnic_sgl_cache[FNIC_SGL_NUM_CACHES]; |
| static struct kmem_cache *fnic_io_req_cache; |
| LIST_HEAD(fnic_list); |
| DEFINE_SPINLOCK(fnic_list_lock); |
| |
| /* Supported devices by fnic module */ |
| static struct pci_device_id fnic_id_table[] = { |
| { PCI_DEVICE(PCI_VENDOR_ID_CISCO, PCI_DEVICE_ID_CISCO_FNIC) }, |
| { 0, } |
| }; |
| |
| MODULE_DESCRIPTION(DRV_DESCRIPTION); |
| MODULE_AUTHOR("Abhijeet Joglekar <abjoglek@cisco.com>, " |
| "Joseph R. Eykholt <jeykholt@cisco.com>"); |
| MODULE_LICENSE("GPL v2"); |
| MODULE_VERSION(DRV_VERSION); |
| MODULE_DEVICE_TABLE(pci, fnic_id_table); |
| |
| unsigned int fnic_log_level; |
| module_param(fnic_log_level, int, S_IRUGO|S_IWUSR); |
| MODULE_PARM_DESC(fnic_log_level, "bit mask of fnic logging levels"); |
| |
| |
| static struct libfc_function_template fnic_transport_template = { |
| .frame_send = fnic_send, |
| .fcp_abort_io = fnic_empty_scsi_cleanup, |
| .fcp_cleanup = fnic_empty_scsi_cleanup, |
| .exch_mgr_reset = fnic_exch_mgr_reset |
| }; |
| |
| static int fnic_slave_alloc(struct scsi_device *sdev) |
| { |
| struct fc_rport *rport = starget_to_rport(scsi_target(sdev)); |
| struct fc_lport *lp = shost_priv(sdev->host); |
| struct fnic *fnic = lport_priv(lp); |
| |
| sdev->tagged_supported = 1; |
| |
| if (!rport || fc_remote_port_chkready(rport)) |
| return -ENXIO; |
| |
| scsi_activate_tcq(sdev, FNIC_DFLT_QUEUE_DEPTH); |
| rport->dev_loss_tmo = fnic->config.port_down_timeout / 1000; |
| |
| return 0; |
| } |
| |
| static struct scsi_host_template fnic_host_template = { |
| .module = THIS_MODULE, |
| .name = DRV_NAME, |
| .queuecommand = fnic_queuecommand, |
| .eh_abort_handler = fnic_abort_cmd, |
| .eh_device_reset_handler = fnic_device_reset, |
| .eh_host_reset_handler = fnic_host_reset, |
| .slave_alloc = fnic_slave_alloc, |
| .change_queue_depth = fc_change_queue_depth, |
| .change_queue_type = fc_change_queue_type, |
| .this_id = -1, |
| .cmd_per_lun = 3, |
| .can_queue = FNIC_MAX_IO_REQ, |
| .use_clustering = ENABLE_CLUSTERING, |
| .sg_tablesize = FNIC_MAX_SG_DESC_CNT, |
| .max_sectors = 0xffff, |
| .shost_attrs = fnic_attrs, |
| }; |
| |
| static void fnic_get_host_speed(struct Scsi_Host *shost); |
| static struct scsi_transport_template *fnic_fc_transport; |
| static struct fc_host_statistics *fnic_get_stats(struct Scsi_Host *); |
| |
| static struct fc_function_template fnic_fc_functions = { |
| |
| .show_host_node_name = 1, |
| .show_host_port_name = 1, |
| .show_host_supported_classes = 1, |
| .show_host_supported_fc4s = 1, |
| .show_host_active_fc4s = 1, |
| .show_host_maxframe_size = 1, |
| .show_host_port_id = 1, |
| .show_host_supported_speeds = 1, |
| .get_host_speed = fnic_get_host_speed, |
| .show_host_speed = 1, |
| .show_host_port_type = 1, |
| .get_host_port_state = fc_get_host_port_state, |
| .show_host_port_state = 1, |
| .show_host_symbolic_name = 1, |
| .show_rport_maxframe_size = 1, |
| .show_rport_supported_classes = 1, |
| .show_host_fabric_name = 1, |
| .show_starget_node_name = 1, |
| .show_starget_port_name = 1, |
| .show_starget_port_id = 1, |
| .show_rport_dev_loss_tmo = 1, |
| .issue_fc_host_lip = fnic_reset, |
| .get_fc_host_stats = fnic_get_stats, |
| .dd_fcrport_size = sizeof(struct fc_rport_libfc_priv), |
| .terminate_rport_io = fnic_terminate_rport_io, |
| }; |
| |
| static void fnic_get_host_speed(struct Scsi_Host *shost) |
| { |
| struct fc_lport *lp = shost_priv(shost); |
| struct fnic *fnic = lport_priv(lp); |
| u32 port_speed = vnic_dev_port_speed(fnic->vdev); |
| |
| /* Add in other values as they get defined in fw */ |
| switch (port_speed) { |
| case 10000: |
| fc_host_speed(shost) = FC_PORTSPEED_10GBIT; |
| break; |
| default: |
| fc_host_speed(shost) = FC_PORTSPEED_10GBIT; |
| break; |
| } |
| } |
| |
| static struct fc_host_statistics *fnic_get_stats(struct Scsi_Host *host) |
| { |
| int ret; |
| struct fc_lport *lp = shost_priv(host); |
| struct fnic *fnic = lport_priv(lp); |
| struct fc_host_statistics *stats = &lp->host_stats; |
| struct vnic_stats *vs; |
| unsigned long flags; |
| |
| if (time_before(jiffies, fnic->stats_time + HZ / FNIC_STATS_RATE_LIMIT)) |
| return stats; |
| fnic->stats_time = jiffies; |
| |
| spin_lock_irqsave(&fnic->fnic_lock, flags); |
| ret = vnic_dev_stats_dump(fnic->vdev, &fnic->stats); |
| spin_unlock_irqrestore(&fnic->fnic_lock, flags); |
| |
| if (ret) { |
| FNIC_MAIN_DBG(KERN_DEBUG, fnic->lport->host, |
| "fnic: Get vnic stats failed" |
| " 0x%x", ret); |
| return stats; |
| } |
| vs = fnic->stats; |
| stats->tx_frames = vs->tx.tx_unicast_frames_ok; |
| stats->tx_words = vs->tx.tx_unicast_bytes_ok / 4; |
| stats->rx_frames = vs->rx.rx_unicast_frames_ok; |
| stats->rx_words = vs->rx.rx_unicast_bytes_ok / 4; |
| stats->error_frames = vs->tx.tx_errors + vs->rx.rx_errors; |
| stats->dumped_frames = vs->tx.tx_drops + vs->rx.rx_drop; |
| stats->invalid_crc_count = vs->rx.rx_crc_errors; |
| stats->seconds_since_last_reset = (jiffies - lp->boot_time) / HZ; |
| stats->fcp_input_megabytes = div_u64(fnic->fcp_input_bytes, 1000000); |
| stats->fcp_output_megabytes = div_u64(fnic->fcp_output_bytes, 1000000); |
| |
| return stats; |
| } |
| |
| void fnic_log_q_error(struct fnic *fnic) |
| { |
| unsigned int i; |
| u32 error_status; |
| |
| for (i = 0; i < fnic->raw_wq_count; i++) { |
| error_status = ioread32(&fnic->wq[i].ctrl->error_status); |
| if (error_status) |
| shost_printk(KERN_ERR, fnic->lport->host, |
| "WQ[%d] error_status" |
| " %d\n", i, error_status); |
| } |
| |
| for (i = 0; i < fnic->rq_count; i++) { |
| error_status = ioread32(&fnic->rq[i].ctrl->error_status); |
| if (error_status) |
| shost_printk(KERN_ERR, fnic->lport->host, |
| "RQ[%d] error_status" |
| " %d\n", i, error_status); |
| } |
| |
| for (i = 0; i < fnic->wq_copy_count; i++) { |
| error_status = ioread32(&fnic->wq_copy[i].ctrl->error_status); |
| if (error_status) |
| shost_printk(KERN_ERR, fnic->lport->host, |
| "CWQ[%d] error_status" |
| " %d\n", i, error_status); |
| } |
| } |
| |
| void fnic_handle_link_event(struct fnic *fnic) |
| { |
| unsigned long flags; |
| |
| spin_lock_irqsave(&fnic->fnic_lock, flags); |
| if (fnic->stop_rx_link_events) { |
| spin_unlock_irqrestore(&fnic->fnic_lock, flags); |
| return; |
| } |
| spin_unlock_irqrestore(&fnic->fnic_lock, flags); |
| |
| queue_work(fnic_event_queue, &fnic->link_work); |
| |
| } |
| |
| static int fnic_notify_set(struct fnic *fnic) |
| { |
| int err; |
| |
| switch (vnic_dev_get_intr_mode(fnic->vdev)) { |
| case VNIC_DEV_INTR_MODE_INTX: |
| err = vnic_dev_notify_set(fnic->vdev, FNIC_INTX_NOTIFY); |
| break; |
| case VNIC_DEV_INTR_MODE_MSI: |
| err = vnic_dev_notify_set(fnic->vdev, -1); |
| break; |
| case VNIC_DEV_INTR_MODE_MSIX: |
| err = vnic_dev_notify_set(fnic->vdev, FNIC_MSIX_ERR_NOTIFY); |
| break; |
| default: |
| shost_printk(KERN_ERR, fnic->lport->host, |
| "Interrupt mode should be set up" |
| " before devcmd notify set %d\n", |
| vnic_dev_get_intr_mode(fnic->vdev)); |
| err = -1; |
| break; |
| } |
| |
| return err; |
| } |
| |
| static void fnic_notify_timer(unsigned long data) |
| { |
| struct fnic *fnic = (struct fnic *)data; |
| |
| fnic_handle_link_event(fnic); |
| mod_timer(&fnic->notify_timer, |
| round_jiffies(jiffies + FNIC_NOTIFY_TIMER_PERIOD)); |
| } |
| |
| static void fnic_notify_timer_start(struct fnic *fnic) |
| { |
| switch (vnic_dev_get_intr_mode(fnic->vdev)) { |
| case VNIC_DEV_INTR_MODE_MSI: |
| /* |
| * Schedule first timeout immediately. The driver is |
| * initiatialized and ready to look for link up notification |
| */ |
| mod_timer(&fnic->notify_timer, jiffies); |
| break; |
| default: |
| /* Using intr for notification for INTx/MSI-X */ |
| break; |
| }; |
| } |
| |
| static int fnic_dev_wait(struct vnic_dev *vdev, |
| int (*start)(struct vnic_dev *, int), |
| int (*finished)(struct vnic_dev *, int *), |
| int arg) |
| { |
| unsigned long time; |
| int done; |
| int err; |
| |
| err = start(vdev, arg); |
| if (err) |
| return err; |
| |
| /* Wait for func to complete...2 seconds max */ |
| time = jiffies + (HZ * 2); |
| do { |
| err = finished(vdev, &done); |
| if (err) |
| return err; |
| if (done) |
| return 0; |
| schedule_timeout_uninterruptible(HZ / 10); |
| } while (time_after(time, jiffies)); |
| |
| return -ETIMEDOUT; |
| } |
| |
| static int fnic_cleanup(struct fnic *fnic) |
| { |
| unsigned int i; |
| int err; |
| unsigned long flags; |
| struct fc_frame *flogi = NULL; |
| struct fc_frame *flogi_resp = NULL; |
| |
| vnic_dev_disable(fnic->vdev); |
| for (i = 0; i < fnic->intr_count; i++) |
| vnic_intr_mask(&fnic->intr[i]); |
| |
| for (i = 0; i < fnic->rq_count; i++) { |
| err = vnic_rq_disable(&fnic->rq[i]); |
| if (err) |
| return err; |
| } |
| for (i = 0; i < fnic->raw_wq_count; i++) { |
| err = vnic_wq_disable(&fnic->wq[i]); |
| if (err) |
| return err; |
| } |
| for (i = 0; i < fnic->wq_copy_count; i++) { |
| err = vnic_wq_copy_disable(&fnic->wq_copy[i]); |
| if (err) |
| return err; |
| } |
| |
| /* Clean up completed IOs and FCS frames */ |
| fnic_wq_copy_cmpl_handler(fnic, -1); |
| fnic_wq_cmpl_handler(fnic, -1); |
| fnic_rq_cmpl_handler(fnic, -1); |
| |
| /* Clean up the IOs and FCS frames that have not completed */ |
| for (i = 0; i < fnic->raw_wq_count; i++) |
| vnic_wq_clean(&fnic->wq[i], fnic_free_wq_buf); |
| for (i = 0; i < fnic->rq_count; i++) |
| vnic_rq_clean(&fnic->rq[i], fnic_free_rq_buf); |
| for (i = 0; i < fnic->wq_copy_count; i++) |
| vnic_wq_copy_clean(&fnic->wq_copy[i], |
| fnic_wq_copy_cleanup_handler); |
| |
| for (i = 0; i < fnic->cq_count; i++) |
| vnic_cq_clean(&fnic->cq[i]); |
| for (i = 0; i < fnic->intr_count; i++) |
| vnic_intr_clean(&fnic->intr[i]); |
| |
| /* |
| * Remove cached flogi and flogi resp frames if any |
| * These frames are not in any queue, and therefore queue |
| * cleanup does not clean them. So clean them explicitly |
| */ |
| spin_lock_irqsave(&fnic->fnic_lock, flags); |
| flogi = fnic->flogi; |
| fnic->flogi = NULL; |
| flogi_resp = fnic->flogi_resp; |
| fnic->flogi_resp = NULL; |
| spin_unlock_irqrestore(&fnic->fnic_lock, flags); |
| |
| if (flogi) |
| dev_kfree_skb(fp_skb(flogi)); |
| |
| if (flogi_resp) |
| dev_kfree_skb(fp_skb(flogi_resp)); |
| |
| mempool_destroy(fnic->io_req_pool); |
| for (i = 0; i < FNIC_SGL_NUM_CACHES; i++) |
| mempool_destroy(fnic->io_sgl_pool[i]); |
| |
| return 0; |
| } |
| |
| static void fnic_iounmap(struct fnic *fnic) |
| { |
| if (fnic->bar0.vaddr) |
| iounmap(fnic->bar0.vaddr); |
| } |
| |
| /* |
| * Allocate element for mempools requiring GFP_DMA flag. |
| * Otherwise, checks in kmem_flagcheck() hit BUG_ON(). |
| */ |
| static void *fnic_alloc_slab_dma(gfp_t gfp_mask, void *pool_data) |
| { |
| struct kmem_cache *mem = pool_data; |
| |
| return kmem_cache_alloc(mem, gfp_mask | GFP_ATOMIC | GFP_DMA); |
| } |
| |
| static int __devinit fnic_probe(struct pci_dev *pdev, |
| const struct pci_device_id *ent) |
| { |
| struct Scsi_Host *host; |
| struct fc_lport *lp; |
| struct fnic *fnic; |
| mempool_t *pool; |
| int err; |
| int i; |
| unsigned long flags; |
| |
| /* |
| * Allocate SCSI Host and set up association between host, |
| * local port, and fnic |
| */ |
| host = scsi_host_alloc(&fnic_host_template, |
| sizeof(struct fc_lport) + sizeof(struct fnic)); |
| if (!host) { |
| printk(KERN_ERR PFX "Unable to alloc SCSI host\n"); |
| err = -ENOMEM; |
| goto err_out; |
| } |
| lp = shost_priv(host); |
| lp->host = host; |
| fnic = lport_priv(lp); |
| fnic->lport = lp; |
| |
| snprintf(fnic->name, sizeof(fnic->name) - 1, "%s%d", DRV_NAME, |
| host->host_no); |
| |
| host->transportt = fnic_fc_transport; |
| |
| err = scsi_init_shared_tag_map(host, FNIC_MAX_IO_REQ); |
| if (err) { |
| shost_printk(KERN_ERR, fnic->lport->host, |
| "Unable to alloc shared tag map\n"); |
| goto err_out_free_hba; |
| } |
| |
| /* Setup PCI resources */ |
| pci_set_drvdata(pdev, fnic); |
| |
| fnic->pdev = pdev; |
| |
| err = pci_enable_device(pdev); |
| if (err) { |
| shost_printk(KERN_ERR, fnic->lport->host, |
| "Cannot enable PCI device, aborting.\n"); |
| goto err_out_free_hba; |
| } |
| |
| err = pci_request_regions(pdev, DRV_NAME); |
| if (err) { |
| shost_printk(KERN_ERR, fnic->lport->host, |
| "Cannot enable PCI resources, aborting\n"); |
| goto err_out_disable_device; |
| } |
| |
| pci_set_master(pdev); |
| |
| /* Query PCI controller on system for DMA addressing |
| * limitation for the device. Try 40-bit first, and |
| * fail to 32-bit. |
| */ |
| err = pci_set_dma_mask(pdev, DMA_BIT_MASK(40)); |
| if (err) { |
| err = pci_set_dma_mask(pdev, DMA_BIT_MASK(32)); |
| if (err) { |
| shost_printk(KERN_ERR, fnic->lport->host, |
| "No usable DMA configuration " |
| "aborting\n"); |
| goto err_out_release_regions; |
| } |
| err = pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(32)); |
| if (err) { |
| shost_printk(KERN_ERR, fnic->lport->host, |
| "Unable to obtain 32-bit DMA " |
| "for consistent allocations, aborting.\n"); |
| goto err_out_release_regions; |
| } |
| } else { |
| err = pci_set_consistent_dma_mask(pdev, DMA_BIT_MASK(40)); |
| if (err) { |
| shost_printk(KERN_ERR, fnic->lport->host, |
| "Unable to obtain 40-bit DMA " |
| "for consistent allocations, aborting.\n"); |
| goto err_out_release_regions; |
| } |
| } |
| |
| /* Map vNIC resources from BAR0 */ |
| if (!(pci_resource_flags(pdev, 0) & IORESOURCE_MEM)) { |
| shost_printk(KERN_ERR, fnic->lport->host, |
| "BAR0 not memory-map'able, aborting.\n"); |
| err = -ENODEV; |
| goto err_out_release_regions; |
| } |
| |
| fnic->bar0.vaddr = pci_iomap(pdev, 0, 0); |
| fnic->bar0.bus_addr = pci_resource_start(pdev, 0); |
| fnic->bar0.len = pci_resource_len(pdev, 0); |
| |
| if (!fnic->bar0.vaddr) { |
| shost_printk(KERN_ERR, fnic->lport->host, |
| "Cannot memory-map BAR0 res hdr, " |
| "aborting.\n"); |
| err = -ENODEV; |
| goto err_out_release_regions; |
| } |
| |
| fnic->vdev = vnic_dev_register(NULL, fnic, pdev, &fnic->bar0); |
| if (!fnic->vdev) { |
| shost_printk(KERN_ERR, fnic->lport->host, |
| "vNIC registration failed, " |
| "aborting.\n"); |
| err = -ENODEV; |
| goto err_out_iounmap; |
| } |
| |
| err = fnic_dev_wait(fnic->vdev, vnic_dev_open, |
| vnic_dev_open_done, 0); |
| if (err) { |
| shost_printk(KERN_ERR, fnic->lport->host, |
| "vNIC dev open failed, aborting.\n"); |
| goto err_out_vnic_unregister; |
| } |
| |
| err = vnic_dev_init(fnic->vdev, 0); |
| if (err) { |
| shost_printk(KERN_ERR, fnic->lport->host, |
| "vNIC dev init failed, aborting.\n"); |
| goto err_out_dev_close; |
| } |
| |
| err = vnic_dev_mac_addr(fnic->vdev, fnic->mac_addr); |
| if (err) { |
| shost_printk(KERN_ERR, fnic->lport->host, |
| "vNIC get MAC addr failed \n"); |
| goto err_out_dev_close; |
| } |
| |
| /* Get vNIC configuration */ |
| err = fnic_get_vnic_config(fnic); |
| if (err) { |
| shost_printk(KERN_ERR, fnic->lport->host, |
| "Get vNIC configuration failed, " |
| "aborting.\n"); |
| goto err_out_dev_close; |
| } |
| host->max_lun = fnic->config.luns_per_tgt; |
| host->max_id = FNIC_MAX_FCP_TARGET; |
| |
| fnic_get_res_counts(fnic); |
| |
| err = fnic_set_intr_mode(fnic); |
| if (err) { |
| shost_printk(KERN_ERR, fnic->lport->host, |
| "Failed to set intr mode, " |
| "aborting.\n"); |
| goto err_out_dev_close; |
| } |
| |
| err = fnic_request_intr(fnic); |
| if (err) { |
| shost_printk(KERN_ERR, fnic->lport->host, |
| "Unable to request irq.\n"); |
| goto err_out_clear_intr; |
| } |
| |
| err = fnic_alloc_vnic_resources(fnic); |
| if (err) { |
| shost_printk(KERN_ERR, fnic->lport->host, |
| "Failed to alloc vNIC resources, " |
| "aborting.\n"); |
| goto err_out_free_intr; |
| } |
| |
| |
| /* initialize all fnic locks */ |
| spin_lock_init(&fnic->fnic_lock); |
| |
| for (i = 0; i < FNIC_WQ_MAX; i++) |
| spin_lock_init(&fnic->wq_lock[i]); |
| |
| for (i = 0; i < FNIC_WQ_COPY_MAX; i++) { |
| spin_lock_init(&fnic->wq_copy_lock[i]); |
| fnic->wq_copy_desc_low[i] = DESC_CLEAN_LOW_WATERMARK; |
| fnic->fw_ack_recd[i] = 0; |
| fnic->fw_ack_index[i] = -1; |
| } |
| |
| for (i = 0; i < FNIC_IO_LOCKS; i++) |
| spin_lock_init(&fnic->io_req_lock[i]); |
| |
| fnic->io_req_pool = mempool_create_slab_pool(2, fnic_io_req_cache); |
| if (!fnic->io_req_pool) |
| goto err_out_free_resources; |
| |
| pool = mempool_create(2, fnic_alloc_slab_dma, mempool_free_slab, |
| fnic_sgl_cache[FNIC_SGL_CACHE_DFLT]); |
| if (!pool) |
| goto err_out_free_ioreq_pool; |
| fnic->io_sgl_pool[FNIC_SGL_CACHE_DFLT] = pool; |
| |
| pool = mempool_create(2, fnic_alloc_slab_dma, mempool_free_slab, |
| fnic_sgl_cache[FNIC_SGL_CACHE_MAX]); |
| if (!pool) |
| goto err_out_free_dflt_pool; |
| fnic->io_sgl_pool[FNIC_SGL_CACHE_MAX] = pool; |
| |
| /* setup vlan config, hw inserts vlan header */ |
| fnic->vlan_hw_insert = 1; |
| fnic->vlan_id = 0; |
| |
| fnic->flogi_oxid = FC_XID_UNKNOWN; |
| fnic->flogi = NULL; |
| fnic->flogi_resp = NULL; |
| fnic->state = FNIC_IN_FC_MODE; |
| |
| /* Enable hardware stripping of vlan header on ingress */ |
| fnic_set_nic_config(fnic, 0, 0, 0, 0, 0, 0, 1); |
| |
| /* Setup notification buffer area */ |
| err = fnic_notify_set(fnic); |
| if (err) { |
| shost_printk(KERN_ERR, fnic->lport->host, |
| "Failed to alloc notify buffer, aborting.\n"); |
| goto err_out_free_max_pool; |
| } |
| |
| /* Setup notify timer when using MSI interrupts */ |
| if (vnic_dev_get_intr_mode(fnic->vdev) == VNIC_DEV_INTR_MODE_MSI) |
| setup_timer(&fnic->notify_timer, |
| fnic_notify_timer, (unsigned long)fnic); |
| |
| /* allocate RQ buffers and post them to RQ*/ |
| for (i = 0; i < fnic->rq_count; i++) { |
| err = vnic_rq_fill(&fnic->rq[i], fnic_alloc_rq_frame); |
| if (err) { |
| shost_printk(KERN_ERR, fnic->lport->host, |
| "fnic_alloc_rq_frame can't alloc " |
| "frame\n"); |
| goto err_out_free_rq_buf; |
| } |
| } |
| |
| /* |
| * Initialization done with PCI system, hardware, firmware. |
| * Add host to SCSI |
| */ |
| err = scsi_add_host(lp->host, &pdev->dev); |
| if (err) { |
| shost_printk(KERN_ERR, fnic->lport->host, |
| "fnic: scsi_add_host failed...exiting\n"); |
| goto err_out_free_rq_buf; |
| } |
| |
| /* Start local port initiatialization */ |
| |
| lp->link_up = 0; |
| lp->tt = fnic_transport_template; |
| |
| lp->emp = fc_exch_mgr_alloc(lp, FC_CLASS_3, |
| FCPIO_HOST_EXCH_RANGE_START, |
| FCPIO_HOST_EXCH_RANGE_END); |
| if (!lp->emp) { |
| err = -ENOMEM; |
| goto err_out_remove_scsi_host; |
| } |
| |
| lp->max_retry_count = fnic->config.flogi_retries; |
| lp->max_rport_retry_count = fnic->config.plogi_retries; |
| lp->service_params = (FCP_SPPF_INIT_FCN | FCP_SPPF_RD_XRDY_DIS | |
| FCP_SPPF_CONF_COMPL); |
| if (fnic->config.flags & VFCF_FCP_SEQ_LVL_ERR) |
| lp->service_params |= FCP_SPPF_RETRY; |
| |
| lp->boot_time = jiffies; |
| lp->e_d_tov = fnic->config.ed_tov; |
| lp->r_a_tov = fnic->config.ra_tov; |
| lp->link_supported_speeds = FC_PORTSPEED_10GBIT; |
| fc_set_wwnn(lp, fnic->config.node_wwn); |
| fc_set_wwpn(lp, fnic->config.port_wwn); |
| |
| fc_exch_init(lp); |
| fc_lport_init(lp); |
| fc_elsct_init(lp); |
| fc_rport_init(lp); |
| fc_disc_init(lp); |
| |
| fc_lport_config(lp); |
| |
| if (fc_set_mfs(lp, fnic->config.maxdatafieldsize + |
| sizeof(struct fc_frame_header))) { |
| err = -EINVAL; |
| goto err_out_free_exch_mgr; |
| } |
| fc_host_maxframe_size(lp->host) = lp->mfs; |
| |
| sprintf(fc_host_symbolic_name(lp->host), |
| DRV_NAME " v" DRV_VERSION " over %s", fnic->name); |
| |
| spin_lock_irqsave(&fnic_list_lock, flags); |
| list_add_tail(&fnic->list, &fnic_list); |
| spin_unlock_irqrestore(&fnic_list_lock, flags); |
| |
| INIT_WORK(&fnic->link_work, fnic_handle_link); |
| INIT_WORK(&fnic->frame_work, fnic_handle_frame); |
| skb_queue_head_init(&fnic->frame_queue); |
| |
| /* Enable all queues */ |
| for (i = 0; i < fnic->raw_wq_count; i++) |
| vnic_wq_enable(&fnic->wq[i]); |
| for (i = 0; i < fnic->rq_count; i++) |
| vnic_rq_enable(&fnic->rq[i]); |
| for (i = 0; i < fnic->wq_copy_count; i++) |
| vnic_wq_copy_enable(&fnic->wq_copy[i]); |
| |
| fc_fabric_login(lp); |
| |
| vnic_dev_enable(fnic->vdev); |
| for (i = 0; i < fnic->intr_count; i++) |
| vnic_intr_unmask(&fnic->intr[i]); |
| |
| fnic_notify_timer_start(fnic); |
| |
| return 0; |
| |
| err_out_free_exch_mgr: |
| fc_exch_mgr_free(lp->emp); |
| err_out_remove_scsi_host: |
| fc_remove_host(fnic->lport->host); |
| scsi_remove_host(fnic->lport->host); |
| err_out_free_rq_buf: |
| for (i = 0; i < fnic->rq_count; i++) |
| vnic_rq_clean(&fnic->rq[i], fnic_free_rq_buf); |
| vnic_dev_notify_unset(fnic->vdev); |
| err_out_free_max_pool: |
| mempool_destroy(fnic->io_sgl_pool[FNIC_SGL_CACHE_MAX]); |
| err_out_free_dflt_pool: |
| mempool_destroy(fnic->io_sgl_pool[FNIC_SGL_CACHE_DFLT]); |
| err_out_free_ioreq_pool: |
| mempool_destroy(fnic->io_req_pool); |
| err_out_free_resources: |
| fnic_free_vnic_resources(fnic); |
| err_out_free_intr: |
| fnic_free_intr(fnic); |
| err_out_clear_intr: |
| fnic_clear_intr_mode(fnic); |
| err_out_dev_close: |
| vnic_dev_close(fnic->vdev); |
| err_out_vnic_unregister: |
| vnic_dev_unregister(fnic->vdev); |
| err_out_iounmap: |
| fnic_iounmap(fnic); |
| err_out_release_regions: |
| pci_release_regions(pdev); |
| err_out_disable_device: |
| pci_disable_device(pdev); |
| err_out_free_hba: |
| scsi_host_put(lp->host); |
| err_out: |
| return err; |
| } |
| |
| static void __devexit fnic_remove(struct pci_dev *pdev) |
| { |
| struct fnic *fnic = pci_get_drvdata(pdev); |
| unsigned long flags; |
| |
| /* |
| * Mark state so that the workqueue thread stops forwarding |
| * received frames and link events to the local port. ISR and |
| * other threads that can queue work items will also stop |
| * creating work items on the fnic workqueue |
| */ |
| spin_lock_irqsave(&fnic->fnic_lock, flags); |
| fnic->stop_rx_link_events = 1; |
| spin_unlock_irqrestore(&fnic->fnic_lock, flags); |
| |
| if (vnic_dev_get_intr_mode(fnic->vdev) == VNIC_DEV_INTR_MODE_MSI) |
| del_timer_sync(&fnic->notify_timer); |
| |
| /* |
| * Flush the fnic event queue. After this call, there should |
| * be no event queued for this fnic device in the workqueue |
| */ |
| flush_workqueue(fnic_event_queue); |
| skb_queue_purge(&fnic->frame_queue); |
| |
| /* |
| * Log off the fabric. This stops all remote ports, dns port, |
| * logs off the fabric. This flushes all rport, disc, lport work |
| * before returning |
| */ |
| fc_fabric_logoff(fnic->lport); |
| |
| spin_lock_irqsave(&fnic->fnic_lock, flags); |
| fnic->in_remove = 1; |
| spin_unlock_irqrestore(&fnic->fnic_lock, flags); |
| |
| fc_lport_destroy(fnic->lport); |
| |
| /* |
| * This stops the fnic device, masks all interrupts. Completed |
| * CQ entries are drained. Posted WQ/RQ/Copy-WQ entries are |
| * cleaned up |
| */ |
| fnic_cleanup(fnic); |
| |
| BUG_ON(!skb_queue_empty(&fnic->frame_queue)); |
| |
| spin_lock_irqsave(&fnic_list_lock, flags); |
| list_del(&fnic->list); |
| spin_unlock_irqrestore(&fnic_list_lock, flags); |
| |
| fc_remove_host(fnic->lport->host); |
| scsi_remove_host(fnic->lport->host); |
| fc_exch_mgr_free(fnic->lport->emp); |
| vnic_dev_notify_unset(fnic->vdev); |
| fnic_free_vnic_resources(fnic); |
| fnic_free_intr(fnic); |
| fnic_clear_intr_mode(fnic); |
| vnic_dev_close(fnic->vdev); |
| vnic_dev_unregister(fnic->vdev); |
| fnic_iounmap(fnic); |
| pci_release_regions(pdev); |
| pci_disable_device(pdev); |
| pci_set_drvdata(pdev, NULL); |
| scsi_host_put(fnic->lport->host); |
| } |
| |
| static struct pci_driver fnic_driver = { |
| .name = DRV_NAME, |
| .id_table = fnic_id_table, |
| .probe = fnic_probe, |
| .remove = __devexit_p(fnic_remove), |
| }; |
| |
| static int __init fnic_init_module(void) |
| { |
| size_t len; |
| int err = 0; |
| |
| printk(KERN_INFO PFX "%s, ver %s\n", DRV_DESCRIPTION, DRV_VERSION); |
| |
| /* Create a cache for allocation of default size sgls */ |
| len = sizeof(struct fnic_dflt_sgl_list); |
| fnic_sgl_cache[FNIC_SGL_CACHE_DFLT] = kmem_cache_create |
| ("fnic_sgl_dflt", len + FNIC_SG_DESC_ALIGN, FNIC_SG_DESC_ALIGN, |
| SLAB_HWCACHE_ALIGN | SLAB_CACHE_DMA, |
| NULL); |
| if (!fnic_sgl_cache[FNIC_SGL_CACHE_DFLT]) { |
| printk(KERN_ERR PFX "failed to create fnic dflt sgl slab\n"); |
| err = -ENOMEM; |
| goto err_create_fnic_sgl_slab_dflt; |
| } |
| |
| /* Create a cache for allocation of max size sgls*/ |
| len = sizeof(struct fnic_sgl_list); |
| fnic_sgl_cache[FNIC_SGL_CACHE_MAX] = kmem_cache_create |
| ("fnic_sgl_max", len + FNIC_SG_DESC_ALIGN, FNIC_SG_DESC_ALIGN, |
| SLAB_HWCACHE_ALIGN | SLAB_CACHE_DMA, |
| NULL); |
| if (!fnic_sgl_cache[FNIC_SGL_CACHE_MAX]) { |
| printk(KERN_ERR PFX "failed to create fnic max sgl slab\n"); |
| err = -ENOMEM; |
| goto err_create_fnic_sgl_slab_max; |
| } |
| |
| /* Create a cache of io_req structs for use via mempool */ |
| fnic_io_req_cache = kmem_cache_create("fnic_io_req", |
| sizeof(struct fnic_io_req), |
| 0, SLAB_HWCACHE_ALIGN, NULL); |
| if (!fnic_io_req_cache) { |
| printk(KERN_ERR PFX "failed to create fnic io_req slab\n"); |
| err = -ENOMEM; |
| goto err_create_fnic_ioreq_slab; |
| } |
| |
| fnic_event_queue = create_singlethread_workqueue("fnic_event_wq"); |
| if (!fnic_event_queue) { |
| printk(KERN_ERR PFX "fnic work queue create failed\n"); |
| err = -ENOMEM; |
| goto err_create_fnic_workq; |
| } |
| |
| spin_lock_init(&fnic_list_lock); |
| INIT_LIST_HEAD(&fnic_list); |
| |
| fnic_fc_transport = fc_attach_transport(&fnic_fc_functions); |
| if (!fnic_fc_transport) { |
| printk(KERN_ERR PFX "fc_attach_transport error\n"); |
| err = -ENOMEM; |
| goto err_fc_transport; |
| } |
| |
| /* register the driver with PCI system */ |
| err = pci_register_driver(&fnic_driver); |
| if (err < 0) { |
| printk(KERN_ERR PFX "pci register error\n"); |
| goto err_pci_register; |
| } |
| return err; |
| |
| err_pci_register: |
| fc_release_transport(fnic_fc_transport); |
| err_fc_transport: |
| destroy_workqueue(fnic_event_queue); |
| err_create_fnic_workq: |
| kmem_cache_destroy(fnic_io_req_cache); |
| err_create_fnic_ioreq_slab: |
| kmem_cache_destroy(fnic_sgl_cache[FNIC_SGL_CACHE_MAX]); |
| err_create_fnic_sgl_slab_max: |
| kmem_cache_destroy(fnic_sgl_cache[FNIC_SGL_CACHE_DFLT]); |
| err_create_fnic_sgl_slab_dflt: |
| return err; |
| } |
| |
| static void __exit fnic_cleanup_module(void) |
| { |
| pci_unregister_driver(&fnic_driver); |
| destroy_workqueue(fnic_event_queue); |
| kmem_cache_destroy(fnic_sgl_cache[FNIC_SGL_CACHE_MAX]); |
| kmem_cache_destroy(fnic_sgl_cache[FNIC_SGL_CACHE_DFLT]); |
| kmem_cache_destroy(fnic_io_req_cache); |
| fc_release_transport(fnic_fc_transport); |
| } |
| |
| module_init(fnic_init_module); |
| module_exit(fnic_cleanup_module); |
| |