Quelle  comminit.c   Sprache: C

// SPDX-License-Identifier: GPL-2.0-or-later
/*
 * Adaptec AAC series RAID controller driver
 * (c) Copyright 2001 Red Hat Inc.
 *
 * based on the old aacraid driver that is..
 * Adaptec aacraid device driver for Linux.
 *
 * Copyright (c) 2000-2010 Adaptec, Inc.
 *               2010-2015 PMC-Sierra, Inc. (aacraid@pmc-sierra.com)
 *               2016-2017 Microsemi Corp. (aacraid@microsemi.com)
 *
 * Module Name:
 *  comminit.c
 *
 * Abstract: This supports the initialization of the host adapter commuication interface.
 *    This is a platform dependent module for the pci cyclone board.
 */

#include <linux/kernel.h>
#include <linux/init.h>
#include <linux/types.h>
#include <linux/pci.h>
#include <linux/spinlock.h>
#include <linux/slab.h>
#include <linux/blkdev.h>
#include <linux/delay.h>
#include <linux/completion.h>
#include <linux/mm.h>
#include <scsi/scsi_host.h>
#include <scsi/scsi_device.h>
#include <scsi/scsi_cmnd.h>

#include "aacraid.h"

struct aac_common aac_config = {
 .irq_mod = 1
};

static inline int aac_is_msix_mode(struct aac_dev *dev)
{
 u32 status = 0;

 if (aac_is_src(dev))
  status = src_readl(dev, MUnit.OMR);
 return (status & AAC_INT_MODE_MSIX);
}

static inline void aac_change_to_intx(struct aac_dev *dev)
{
 aac_src_access_devreg(dev, AAC_DISABLE_MSIX);
 aac_src_access_devreg(dev, AAC_ENABLE_INTX);
}

static int aac_alloc_comm(struct aac_dev *dev, void **commaddr, unsigned long commsize, unsigned long commalign)
{
 unsigned char *base;
 unsigned long size, align;
 const unsigned long fibsize = dev->max_fib_size;
 const unsigned long printfbufsiz = 256;
 unsigned long host_rrq_size, aac_init_size;
 union aac_init *init;
 dma_addr_t phys;
 unsigned long aac_max_hostphysmempages;

 if ((dev->comm_interface == AAC_COMM_MESSAGE_TYPE1) ||
  (dev->comm_interface == AAC_COMM_MESSAGE_TYPE2) ||
  (dev->comm_interface == AAC_COMM_MESSAGE_TYPE3 &&
  !dev->sa_firmware)) {
  host_rrq_size =
   (dev->scsi_host_ptr->can_queue + AAC_NUM_MGT_FIB)
    * sizeof(u32);
  aac_init_size = sizeof(union aac_init);
 } else if (dev->comm_interface == AAC_COMM_MESSAGE_TYPE3 &&
  dev->sa_firmware) {
  host_rrq_size = (dev->scsi_host_ptr->can_queue
   + AAC_NUM_MGT_FIB) * sizeof(u32)  * AAC_MAX_MSIX;
  aac_init_size = sizeof(union aac_init) +
   (AAC_MAX_HRRQ - 1) * sizeof(struct _rrq);
 } else {
  host_rrq_size = 0;
  aac_init_size = sizeof(union aac_init);
 }
 size = fibsize + aac_init_size + commsize + commalign +
   printfbufsiz + host_rrq_size;

 base = dma_alloc_coherent(&dev->pdev->dev, size, &phys, GFP_KERNEL);
 if (base == NULL) {
  printk(KERN_ERR "aacraid: unable to create mapping.\n");
  return 0;
 }

 dev->comm_addr = (void *)base;
 dev->comm_phys = phys;
 dev->comm_size = size;

 if ((dev->comm_interface == AAC_COMM_MESSAGE_TYPE1) ||
     (dev->comm_interface == AAC_COMM_MESSAGE_TYPE2) ||
     (dev->comm_interface == AAC_COMM_MESSAGE_TYPE3)) {
  dev->host_rrq = (u32 *)(base + fibsize);
  dev->host_rrq_pa = phys + fibsize;
  memset(dev->host_rrq, 0, host_rrq_size);
 }

 dev->init = (union aac_init *)(base + fibsize + host_rrq_size);
 dev->init_pa = phys + fibsize + host_rrq_size;

 init = dev->init;

 if (dev->comm_interface == AAC_COMM_MESSAGE_TYPE3) {
  int i;
  u64 addr;

  init->r8.init_struct_revision =
   cpu_to_le32(ADAPTER_INIT_STRUCT_REVISION_8);
  init->r8.init_flags = cpu_to_le32(INITFLAGS_NEW_COMM_SUPPORTED |
     INITFLAGS_DRIVER_USES_UTC_TIME |
     INITFLAGS_DRIVER_SUPPORTS_PM);
  init->r8.init_flags |=
    cpu_to_le32(INITFLAGS_DRIVER_SUPPORTS_HBA_MODE);
  init->r8.rr_queue_count = cpu_to_le32(dev->max_msix);
  init->r8.max_io_size =
   cpu_to_le32(dev->scsi_host_ptr->max_sectors << 9);
  init->r8.max_num_aif = init->r8.reserved1 =
   init->r8.reserved2 = 0;

  for (i = 0; i < dev->max_msix; i++) {
   addr = (u64)dev->host_rrq_pa + dev->vector_cap * i *
     sizeof(u32);
   init->r8.rrq[i].host_addr_high = cpu_to_le32(
      upper_32_bits(addr));
   init->r8.rrq[i].host_addr_low = cpu_to_le32(
      lower_32_bits(addr));
   init->r8.rrq[i].msix_id = i;
   init->r8.rrq[i].element_count = cpu_to_le16(
     (u16)dev->vector_cap);
   init->r8.rrq[i].comp_thresh =
     init->r8.rrq[i].unused = 0;
  }

  pr_warn("aacraid: Comm Interface type3 enabled\n");
 } else {
  init->r7.init_struct_revision =
   cpu_to_le32(ADAPTER_INIT_STRUCT_REVISION);
  if (dev->max_fib_size != sizeof(struct hw_fib))
   init->r7.init_struct_revision =
    cpu_to_le32(ADAPTER_INIT_STRUCT_REVISION_4);
  init->r7.no_of_msix_vectors = cpu_to_le32(SA_MINIPORT_REVISION);
  init->r7.fsrev = cpu_to_le32(dev->fsrev);

  /*
 * Adapter Fibs are the first thing allocated so that they
 * start page aligned
 */
  dev->aif_base_va = (struct hw_fib *)base;

  init->r7.adapter_fibs_virtual_address = 0;
  init->r7.adapter_fibs_physical_address = cpu_to_le32((u32)phys);
  init->r7.adapter_fibs_size = cpu_to_le32(fibsize);
  init->r7.adapter_fib_align = cpu_to_le32(sizeof(struct hw_fib));

  /*
 * number of 4k pages of host physical memory. The aacraid fw
 * needs this number to be less than 4gb worth of pages. New
 * firmware doesn't have any issues with the mapping system, but
 * older Firmware did, and had *troubles* dealing with the math
 * overloading past 32 bits, thus we must limit this field.
 */
  aac_max_hostphysmempages =
    dma_get_required_mask(&dev->pdev->dev) >> 12;
  if (aac_max_hostphysmempages < AAC_MAX_HOSTPHYSMEMPAGES)
   init->r7.host_phys_mem_pages =
     cpu_to_le32(aac_max_hostphysmempages);
  else
   init->r7.host_phys_mem_pages =
     cpu_to_le32(AAC_MAX_HOSTPHYSMEMPAGES);

  init->r7.init_flags =
   cpu_to_le32(INITFLAGS_DRIVER_USES_UTC_TIME |
   INITFLAGS_DRIVER_SUPPORTS_PM);
  init->r7.max_io_commands =
   cpu_to_le32(dev->scsi_host_ptr->can_queue +
     AAC_NUM_MGT_FIB);
  init->r7.max_io_size =
   cpu_to_le32(dev->scsi_host_ptr->max_sectors << 9);
  init->r7.max_fib_size = cpu_to_le32(dev->max_fib_size);
  init->r7.max_num_aif = cpu_to_le32(dev->max_num_aif);

  if (dev->comm_interface == AAC_COMM_MESSAGE) {
   init->r7.init_flags |=
    cpu_to_le32(INITFLAGS_NEW_COMM_SUPPORTED);
   pr_warn("aacraid: Comm Interface enabled\n");
  } else if (dev->comm_interface == AAC_COMM_MESSAGE_TYPE1) {
   init->r7.init_struct_revision =
    cpu_to_le32(ADAPTER_INIT_STRUCT_REVISION_6);
   init->r7.init_flags |=
    cpu_to_le32(INITFLAGS_NEW_COMM_SUPPORTED |
    INITFLAGS_NEW_COMM_TYPE1_SUPPORTED |
    INITFLAGS_FAST_JBOD_SUPPORTED);
   init->r7.host_rrq_addr_high =
    cpu_to_le32(upper_32_bits(dev->host_rrq_pa));
   init->r7.host_rrq_addr_low =
    cpu_to_le32(lower_32_bits(dev->host_rrq_pa));
   pr_warn("aacraid: Comm Interface type1 enabled\n");
  } else if (dev->comm_interface == AAC_COMM_MESSAGE_TYPE2) {
   init->r7.init_struct_revision =
    cpu_to_le32(ADAPTER_INIT_STRUCT_REVISION_7);
   init->r7.init_flags |=
    cpu_to_le32(INITFLAGS_NEW_COMM_SUPPORTED |
    INITFLAGS_NEW_COMM_TYPE2_SUPPORTED |
    INITFLAGS_FAST_JBOD_SUPPORTED);
   init->r7.host_rrq_addr_high =
    cpu_to_le32(upper_32_bits(dev->host_rrq_pa));
   init->r7.host_rrq_addr_low =
    cpu_to_le32(lower_32_bits(dev->host_rrq_pa));
   init->r7.no_of_msix_vectors =
    cpu_to_le32(dev->max_msix);
   /* must be the COMM_PREFERRED_SETTINGS values */
   pr_warn("aacraid: Comm Interface type2 enabled\n");
  }
 }

 /*
 * Increment the base address by the amount already used
 */
 base = base + fibsize + host_rrq_size + aac_init_size;
 phys = (dma_addr_t)((ulong)phys + fibsize + host_rrq_size +
   aac_init_size);

 /*
 * Align the beginning of Headers to commalign
 */
 align = (commalign - ((uintptr_t)(base) & (commalign - 1)));
 base = base + align;
 phys = phys + align;
 /*
 * Fill in addresses of the Comm Area Headers and Queues
 */
 *commaddr = base;
 if (dev->comm_interface != AAC_COMM_MESSAGE_TYPE3)
  init->r7.comm_header_address = cpu_to_le32((u32)phys);
 /*
 * Increment the base address by the size of the CommArea
 */
 base = base + commsize;
 phys = phys + commsize;
 /*
 *  Place the Printf buffer area after the Fast I/O comm area.
 */
 dev->printfbuf = (void *)base;
 if (dev->comm_interface != AAC_COMM_MESSAGE_TYPE3) {
  init->r7.printfbuf = cpu_to_le32(phys);
  init->r7.printfbufsiz = cpu_to_le32(printfbufsiz);
 }
 memset(base, 0, printfbufsiz);
 return 1;
}

static void aac_queue_init(struct aac_dev * dev, struct aac_queue * q, u32 *mem, int qsize)
{
 atomic_set(&q->numpending, 0);
 q->dev = dev;
 init_waitqueue_head(&q->cmdready);
 INIT_LIST_HEAD(&q->cmdq);
 init_waitqueue_head(&q->qfull);
 spin_lock_init(&q->lockdata);
 q->lock = &q->lockdata;
 q->headers.producer = (__le32 *)mem;
 q->headers.consumer = (__le32 *)(mem+1);
 *(q->headers.producer) = cpu_to_le32(qsize);
 *(q->headers.consumer) = cpu_to_le32(qsize);
 q->entries = qsize;
}

static bool wait_for_io_iter(struct scsi_cmnd *cmd, void *data)
{
 int *active = data;

 if (aac_priv(cmd)->owner == AAC_OWNER_FIRMWARE)
  *active = *active + 1;
 return true;
}
static void aac_wait_for_io_completion(struct aac_dev *aac)
{
 int i = 0, active;

 for (i = 60; i; --i) {

  active = 0;
  scsi_host_busy_iter(aac->scsi_host_ptr,
        wait_for_io_iter, &active);
  /*
 * We can exit If all the commands are complete
 */
  if (active == 0)
   break;
  dev_info(&aac->pdev->dev,
    "Wait for %d commands to complete\n", active);
  ssleep(1);
 }
 if (active)
  dev_err(&aac->pdev->dev,
   "%d outstanding commands during shutdown\n", active);
}

/**
 * aac_send_shutdown - shutdown an adapter
 * @dev: Adapter to shutdown
 *
 * This routine will send a VM_CloseAll (shutdown) request to the adapter.
 */

int aac_send_shutdown(struct aac_dev * dev)
{
 struct fib * fibctx;
 struct aac_close *cmd;
 int status = 0;

 if (aac_adapter_check_health(dev))
  return status;

 if (!dev->adapter_shutdown) {
  mutex_lock(&dev->ioctl_mutex);
  dev->adapter_shutdown = 1;
  mutex_unlock(&dev->ioctl_mutex);
 }

 aac_wait_for_io_completion(dev);

 fibctx = aac_fib_alloc(dev);
 if (!fibctx)
  return -ENOMEM;
 aac_fib_init(fibctx);

 cmd = (struct aac_close *) fib_data(fibctx);
 cmd->command = cpu_to_le32(VM_CloseAll);
 cmd->cid = cpu_to_le32(0xfffffffe);

 status = aac_fib_send(ContainerCommand,
     fibctx,
     sizeof(struct aac_close),
     FsaNormal,
     -2 /* Timeout silently */, 1,
     NULL, NULL);

 if (status >= 0)
  aac_fib_complete(fibctx);
 /* FIB should be freed only after getting the response from the F/W */
 if (status != -ERESTARTSYS)
  aac_fib_free(fibctx);
 if (aac_is_src(dev) &&
      dev->msi_enabled)
  aac_set_intx_mode(dev);
 return status;
}

/**
 * aac_comm_init - Initialise FSA data structures
 * @dev: Adapter to initialise
 *
 * Initializes the data structures that are required for the FSA commuication
 * interface to operate. 
 * Returns
 * 1 - if we were able to init the commuication interface.
 * 0 - If there were errors initing. This is a fatal error.
 */
 
static int aac_comm_init(struct aac_dev * dev)
{
 unsigned long hdrsize = (sizeof(u32) * NUMBER_OF_COMM_QUEUES) * 2;
 unsigned long queuesize = sizeof(struct aac_entry) * TOTAL_QUEUE_ENTRIES;
 u32 *headers;
 struct aac_entry * queues;
 unsigned long size;
 struct aac_queue_block * comm = dev->queues;
 /*
 * Now allocate and initialize the zone structures used as our 
 * pool of FIB context records.  The size of the zone is based
 * on the system memory size.  We also initialize the mutex used
 * to protect the zone.
 */
 spin_lock_init(&dev->fib_lock);

 /*
 * Allocate the physically contiguous space for the commuication
 * queue headers. 
 */

 size = hdrsize + queuesize;

 if (!aac_alloc_comm(dev, (void * *)&headers, size, QUEUE_ALIGNMENT))
  return -ENOMEM;

 queues = (struct aac_entry *)(((ulong)headers) + hdrsize);

 /* Adapter to Host normal priority Command queue */ 
 comm->queue[HostNormCmdQueue].base = queues;
 aac_queue_init(dev, &comm->queue[HostNormCmdQueue], headers, HOST_NORM_CMD_ENTRIES);
 queues += HOST_NORM_CMD_ENTRIES;
 headers += 2;

 /* Adapter to Host high priority command queue */
 comm->queue[HostHighCmdQueue].base = queues;
 aac_queue_init(dev, &comm->queue[HostHighCmdQueue], headers, HOST_HIGH_CMD_ENTRIES);
    
 queues += HOST_HIGH_CMD_ENTRIES;
 headers +=2;

 /* Host to adapter normal priority command queue */
 comm->queue[AdapNormCmdQueue].base = queues;
 aac_queue_init(dev, &comm->queue[AdapNormCmdQueue], headers, ADAP_NORM_CMD_ENTRIES);
    
 queues += ADAP_NORM_CMD_ENTRIES;
 headers += 2;

 /* host to adapter high priority command queue */
 comm->queue[AdapHighCmdQueue].base = queues;
 aac_queue_init(dev, &comm->queue[AdapHighCmdQueue], headers, ADAP_HIGH_CMD_ENTRIES);
    
 queues += ADAP_HIGH_CMD_ENTRIES;
 headers += 2;

 /* adapter to host normal priority response queue */
 comm->queue[HostNormRespQueue].base = queues;
 aac_queue_init(dev, &comm->queue[HostNormRespQueue], headers, HOST_NORM_RESP_ENTRIES);
 queues += HOST_NORM_RESP_ENTRIES;
 headers += 2;

 /* adapter to host high priority response queue */
 comm->queue[HostHighRespQueue].base = queues;
 aac_queue_init(dev, &comm->queue[HostHighRespQueue], headers, HOST_HIGH_RESP_ENTRIES);
   
 queues += HOST_HIGH_RESP_ENTRIES;
 headers += 2;

 /* host to adapter normal priority response queue */
 comm->queue[AdapNormRespQueue].base = queues;
 aac_queue_init(dev, &comm->queue[AdapNormRespQueue], headers, ADAP_NORM_RESP_ENTRIES);

 queues += ADAP_NORM_RESP_ENTRIES;
 headers += 2;
 
 /* host to adapter high priority response queue */ 
 comm->queue[AdapHighRespQueue].base = queues;
 aac_queue_init(dev, &comm->queue[AdapHighRespQueue], headers, ADAP_HIGH_RESP_ENTRIES);

 comm->queue[AdapNormCmdQueue].lock = comm->queue[HostNormRespQueue].lock;
 comm->queue[AdapHighCmdQueue].lock = comm->queue[HostHighRespQueue].lock;
 comm->queue[AdapNormRespQueue].lock = comm->queue[HostNormCmdQueue].lock;
 comm->queue[AdapHighRespQueue].lock = comm->queue[HostHighCmdQueue].lock;

 return 0;
}

void aac_define_int_mode(struct aac_dev *dev)
{
 int i, msi_count, min_msix;

 msi_count = i = 0;
 /* max. vectors from GET_COMM_PREFERRED_SETTINGS */
 if (dev->max_msix == 0 ||
     dev->pdev->device == PMC_DEVICE_S6 ||
     dev->sync_mode) {
  dev->max_msix = 1;
  dev->vector_cap =
   dev->scsi_host_ptr->can_queue +
   AAC_NUM_MGT_FIB;
  return;
 }

 /* Don't bother allocating more MSI-X vectors than cpus */
 msi_count = min(dev->max_msix,
  (unsigned int)num_online_cpus());

 dev->max_msix = msi_count;

 if (msi_count > AAC_MAX_MSIX)
  msi_count = AAC_MAX_MSIX;

 if (msi_count > 1 &&
     pci_find_capability(dev->pdev, PCI_CAP_ID_MSIX)) {
  min_msix = 2;
  i = pci_alloc_irq_vectors(dev->pdev,
       min_msix, msi_count, PCI_IRQ_MSIX);
  if (i > 0) {
   dev->msi_enabled = 1;
   msi_count = i;
  } else {
   dev->msi_enabled = 0;
   dev_err(&dev->pdev->dev,
   "MSIX not supported!! Will try INTX 0x%x.\n", i);
  }
 }

 if (!dev->msi_enabled)
  dev->max_msix = msi_count = 1;
 else {
  if (dev->max_msix > msi_count)
   dev->max_msix = msi_count;
 }
 if (dev->comm_interface == AAC_COMM_MESSAGE_TYPE3 && dev->sa_firmware)
  dev->vector_cap = dev->scsi_host_ptr->can_queue +
    AAC_NUM_MGT_FIB;
 else
  dev->vector_cap = (dev->scsi_host_ptr->can_queue +
    AAC_NUM_MGT_FIB) / msi_count;

}
struct aac_dev *aac_init_adapter(struct aac_dev *dev)
{
 u32 status[5];
 struct Scsi_Host * host = dev->scsi_host_ptr;
 extern int aac_sync_mode;

 /*
 * Check the preferred comm settings, defaults from template.
 */
 dev->management_fib_count = 0;
 spin_lock_init(&dev->manage_lock);
 spin_lock_init(&dev->sync_lock);
 spin_lock_init(&dev->iq_lock);
 dev->max_fib_size = sizeof(struct hw_fib);
 dev->sg_tablesize = host->sg_tablesize = (dev->max_fib_size
  - sizeof(struct aac_fibhdr) - sizeof(struct aac_write))
   / sizeof(struct sgentry);
 dev->comm_interface = AAC_COMM_PRODUCER;
 dev->raw_io_interface = dev->raw_io_64 = 0;


 /*
 * Enable INTX mode, if not done already Enabled
 */
 if (aac_is_msix_mode(dev)) {
  aac_change_to_intx(dev);
  dev_info(&dev->pdev->dev, "Changed firmware to INTX mode");
 }

 if ((!aac_adapter_sync_cmd(dev, GET_ADAPTER_PROPERTIES,
  0, 0, 0, 0, 0, 0,
  status+0, status+1, status+2, status+3, status+4)) &&
  (status[0] == 0x00000001)) {
  dev->doorbell_mask = status[3];
  if (status[1] & AAC_OPT_NEW_COMM_64)
   dev->raw_io_64 = 1;
  dev->sync_mode = aac_sync_mode;
  if (dev->a_ops.adapter_comm &&
      (status[1] & AAC_OPT_NEW_COMM)) {
   dev->comm_interface = AAC_COMM_MESSAGE;
   dev->raw_io_interface = 1;
   if ((status[1] & AAC_OPT_NEW_COMM_TYPE1)) {
    /* driver supports TYPE1 (Tupelo) */
    dev->comm_interface = AAC_COMM_MESSAGE_TYPE1;
   } else if (status[1] & AAC_OPT_NEW_COMM_TYPE2) {
    /* driver supports TYPE2 (Denali, Yosemite) */
    dev->comm_interface = AAC_COMM_MESSAGE_TYPE2;
   } else if (status[1] & AAC_OPT_NEW_COMM_TYPE3) {
    /* driver supports TYPE3 (Yosemite, Thor) */
    dev->comm_interface = AAC_COMM_MESSAGE_TYPE3;
   } else if (status[1] & AAC_OPT_NEW_COMM_TYPE4) {
    /* not supported TYPE - switch to sync. mode */
    dev->comm_interface = AAC_COMM_MESSAGE_TYPE2;
    dev->sync_mode = 1;
   }
  }
  if ((status[1] & le32_to_cpu(AAC_OPT_EXTENDED)) &&
   (status[4] & le32_to_cpu(AAC_EXTOPT_SA_FIRMWARE)))
   dev->sa_firmware = 1;
  else
   dev->sa_firmware = 0;

  if (status[4] & le32_to_cpu(AAC_EXTOPT_SOFT_RESET))
   dev->soft_reset_support = 1;
  else
   dev->soft_reset_support = 0;

  if ((dev->comm_interface == AAC_COMM_MESSAGE) &&
      (status[2] > dev->base_size)) {
   aac_adapter_ioremap(dev, 0);
   dev->base_size = status[2];
   if (aac_adapter_ioremap(dev, status[2])) {
    /* remap failed, go back ... */
    dev->comm_interface = AAC_COMM_PRODUCER;
    if (aac_adapter_ioremap(dev, AAC_MIN_FOOTPRINT_SIZE)) {
     printk(KERN_WARNING
       "aacraid: unable to map adapter.\n");
     return NULL;
    }
   }
  }
 }
 dev->max_msix = 0;
 dev->msi_enabled = 0;
 dev->adapter_shutdown = 0;
 if ((!aac_adapter_sync_cmd(dev, GET_COMM_PREFERRED_SETTINGS,
   0, 0, 0, 0, 0, 0,
   status+0, status+1, status+2, status+3, status+4))
  && (status[0] == 0x00000001)) {
  /*
 * status[1] >> 16 maximum command size in KB
 * status[1] & 0xFFFF maximum FIB size
 * status[2] >> 16 maximum SG elements to driver
 * status[2] & 0xFFFF maximum SG elements from driver
 * status[3] & 0xFFFF maximum number FIBs outstanding
 */
  host->max_sectors = (status[1] >> 16) << 1;
  /* Multiple of 32 for PMC */
  dev->max_fib_size = status[1] & 0xFFE0;
  host->sg_tablesize = status[2] >> 16;
  dev->sg_tablesize = status[2] & 0xFFFF;
  if (aac_is_src(dev)) {
   if (host->can_queue > (status[3] >> 16) -
     AAC_NUM_MGT_FIB)
    host->can_queue = (status[3] >> 16) -
     AAC_NUM_MGT_FIB;
  } else if (host->can_queue > (status[3] & 0xFFFF) -
    AAC_NUM_MGT_FIB)
   host->can_queue = (status[3] & 0xFFFF) -
    AAC_NUM_MGT_FIB;

  dev->max_num_aif = status[4] & 0xFFFF;
 }
 if (numacb > 0) {
  if (numacb < host->can_queue)
   host->can_queue = numacb;
  else
   pr_warn("numacb=%d ignored\n", numacb);
 }

 if (aac_is_src(dev))
  aac_define_int_mode(dev);
 /*
 * Ok now init the communication subsystem
 */

 dev->queues = kzalloc(sizeof(struct aac_queue_block), GFP_KERNEL);
 if (dev->queues == NULL) {
  printk(KERN_ERR "Error could not allocate comm region.\n");
  return NULL;
 }

 if (aac_comm_init(dev)<0){
  kfree(dev->queues);
  dev->queues = NULL;
  return NULL;
 }
 /*
 * Initialize the list of fibs
 */
 if (aac_fib_setup(dev) < 0) {
  kfree(dev->queues);
  dev->queues = NULL;
  return NULL;
 }
  
 INIT_LIST_HEAD(&dev->fib_list);
 INIT_LIST_HEAD(&dev->sync_fib_list);

 return dev;
}