662 lines · c
1// SPDX-License-Identifier: GPL-2.0-or-later2/*3 * Adaptec AAC series RAID controller driver4 * (c) Copyright 2001 Red Hat Inc.5 *6 * based on the old aacraid driver that is..7 * Adaptec aacraid device driver for Linux.8 *9 * Copyright (c) 2000-2010 Adaptec, Inc.10 * 2010-2015 PMC-Sierra, Inc. (aacraid@pmc-sierra.com)11 * 2016-2017 Microsemi Corp. (aacraid@microsemi.com)12 *13 * Module Name:14 * comminit.c15 *16 * Abstract: This supports the initialization of the host adapter commuication interface.17 * This is a platform dependent module for the pci cyclone board.18 */19 20#include <linux/kernel.h>21#include <linux/init.h>22#include <linux/types.h>23#include <linux/pci.h>24#include <linux/spinlock.h>25#include <linux/slab.h>26#include <linux/blkdev.h>27#include <linux/delay.h>28#include <linux/completion.h>29#include <linux/mm.h>30#include <scsi/scsi_host.h>31#include <scsi/scsi_device.h>32#include <scsi/scsi_cmnd.h>33 34#include "aacraid.h"35 36struct aac_common aac_config = {37 .irq_mod = 138};39 40static inline int aac_is_msix_mode(struct aac_dev *dev)41{42 u32 status = 0;43 44 if (aac_is_src(dev))45 status = src_readl(dev, MUnit.OMR);46 return (status & AAC_INT_MODE_MSIX);47}48 49static inline void aac_change_to_intx(struct aac_dev *dev)50{51 aac_src_access_devreg(dev, AAC_DISABLE_MSIX);52 aac_src_access_devreg(dev, AAC_ENABLE_INTX);53}54 55static int aac_alloc_comm(struct aac_dev *dev, void **commaddr, unsigned long commsize, unsigned long commalign)56{57 unsigned char *base;58 unsigned long size, align;59 const unsigned long fibsize = dev->max_fib_size;60 const unsigned long printfbufsiz = 256;61 unsigned long host_rrq_size, aac_init_size;62 union aac_init *init;63 dma_addr_t phys;64 unsigned long aac_max_hostphysmempages;65 66 if ((dev->comm_interface == AAC_COMM_MESSAGE_TYPE1) ||67 (dev->comm_interface == AAC_COMM_MESSAGE_TYPE2) ||68 (dev->comm_interface == AAC_COMM_MESSAGE_TYPE3 &&69 !dev->sa_firmware)) {70 host_rrq_size =71 (dev->scsi_host_ptr->can_queue + AAC_NUM_MGT_FIB)72 * sizeof(u32);73 aac_init_size = sizeof(union aac_init);74 } else if (dev->comm_interface == AAC_COMM_MESSAGE_TYPE3 &&75 dev->sa_firmware) {76 host_rrq_size = (dev->scsi_host_ptr->can_queue77 + AAC_NUM_MGT_FIB) * sizeof(u32) * AAC_MAX_MSIX;78 aac_init_size = sizeof(union aac_init) +79 (AAC_MAX_HRRQ - 1) * sizeof(struct _rrq);80 } else {81 host_rrq_size = 0;82 aac_init_size = sizeof(union aac_init);83 }84 size = fibsize + aac_init_size + commsize + commalign +85 printfbufsiz + host_rrq_size;86 87 base = dma_alloc_coherent(&dev->pdev->dev, size, &phys, GFP_KERNEL);88 if (base == NULL) {89 printk(KERN_ERR "aacraid: unable to create mapping.\n");90 return 0;91 }92 93 dev->comm_addr = (void *)base;94 dev->comm_phys = phys;95 dev->comm_size = size;96 97 if ((dev->comm_interface == AAC_COMM_MESSAGE_TYPE1) ||98 (dev->comm_interface == AAC_COMM_MESSAGE_TYPE2) ||99 (dev->comm_interface == AAC_COMM_MESSAGE_TYPE3)) {100 dev->host_rrq = (u32 *)(base + fibsize);101 dev->host_rrq_pa = phys + fibsize;102 memset(dev->host_rrq, 0, host_rrq_size);103 }104 105 dev->init = (union aac_init *)(base + fibsize + host_rrq_size);106 dev->init_pa = phys + fibsize + host_rrq_size;107 108 init = dev->init;109 110 if (dev->comm_interface == AAC_COMM_MESSAGE_TYPE3) {111 int i;112 u64 addr;113 114 init->r8.init_struct_revision =115 cpu_to_le32(ADAPTER_INIT_STRUCT_REVISION_8);116 init->r8.init_flags = cpu_to_le32(INITFLAGS_NEW_COMM_SUPPORTED |117 INITFLAGS_DRIVER_USES_UTC_TIME |118 INITFLAGS_DRIVER_SUPPORTS_PM);119 init->r8.init_flags |=120 cpu_to_le32(INITFLAGS_DRIVER_SUPPORTS_HBA_MODE);121 init->r8.rr_queue_count = cpu_to_le32(dev->max_msix);122 init->r8.max_io_size =123 cpu_to_le32(dev->scsi_host_ptr->max_sectors << 9);124 init->r8.max_num_aif = init->r8.reserved1 =125 init->r8.reserved2 = 0;126 127 for (i = 0; i < dev->max_msix; i++) {128 addr = (u64)dev->host_rrq_pa + dev->vector_cap * i *129 sizeof(u32);130 init->r8.rrq[i].host_addr_high = cpu_to_le32(131 upper_32_bits(addr));132 init->r8.rrq[i].host_addr_low = cpu_to_le32(133 lower_32_bits(addr));134 init->r8.rrq[i].msix_id = i;135 init->r8.rrq[i].element_count = cpu_to_le16(136 (u16)dev->vector_cap);137 init->r8.rrq[i].comp_thresh =138 init->r8.rrq[i].unused = 0;139 }140 141 pr_warn("aacraid: Comm Interface type3 enabled\n");142 } else {143 init->r7.init_struct_revision =144 cpu_to_le32(ADAPTER_INIT_STRUCT_REVISION);145 if (dev->max_fib_size != sizeof(struct hw_fib))146 init->r7.init_struct_revision =147 cpu_to_le32(ADAPTER_INIT_STRUCT_REVISION_4);148 init->r7.no_of_msix_vectors = cpu_to_le32(SA_MINIPORT_REVISION);149 init->r7.fsrev = cpu_to_le32(dev->fsrev);150 151 /*152 * Adapter Fibs are the first thing allocated so that they153 * start page aligned154 */155 dev->aif_base_va = (struct hw_fib *)base;156 157 init->r7.adapter_fibs_virtual_address = 0;158 init->r7.adapter_fibs_physical_address = cpu_to_le32((u32)phys);159 init->r7.adapter_fibs_size = cpu_to_le32(fibsize);160 init->r7.adapter_fib_align = cpu_to_le32(sizeof(struct hw_fib));161 162 /*163 * number of 4k pages of host physical memory. The aacraid fw164 * needs this number to be less than 4gb worth of pages. New165 * firmware doesn't have any issues with the mapping system, but166 * older Firmware did, and had *troubles* dealing with the math167 * overloading past 32 bits, thus we must limit this field.168 */169 aac_max_hostphysmempages =170 dma_get_required_mask(&dev->pdev->dev) >> 12;171 if (aac_max_hostphysmempages < AAC_MAX_HOSTPHYSMEMPAGES)172 init->r7.host_phys_mem_pages =173 cpu_to_le32(aac_max_hostphysmempages);174 else175 init->r7.host_phys_mem_pages =176 cpu_to_le32(AAC_MAX_HOSTPHYSMEMPAGES);177 178 init->r7.init_flags =179 cpu_to_le32(INITFLAGS_DRIVER_USES_UTC_TIME |180 INITFLAGS_DRIVER_SUPPORTS_PM);181 init->r7.max_io_commands =182 cpu_to_le32(dev->scsi_host_ptr->can_queue +183 AAC_NUM_MGT_FIB);184 init->r7.max_io_size =185 cpu_to_le32(dev->scsi_host_ptr->max_sectors << 9);186 init->r7.max_fib_size = cpu_to_le32(dev->max_fib_size);187 init->r7.max_num_aif = cpu_to_le32(dev->max_num_aif);188 189 if (dev->comm_interface == AAC_COMM_MESSAGE) {190 init->r7.init_flags |=191 cpu_to_le32(INITFLAGS_NEW_COMM_SUPPORTED);192 pr_warn("aacraid: Comm Interface enabled\n");193 } else if (dev->comm_interface == AAC_COMM_MESSAGE_TYPE1) {194 init->r7.init_struct_revision =195 cpu_to_le32(ADAPTER_INIT_STRUCT_REVISION_6);196 init->r7.init_flags |=197 cpu_to_le32(INITFLAGS_NEW_COMM_SUPPORTED |198 INITFLAGS_NEW_COMM_TYPE1_SUPPORTED |199 INITFLAGS_FAST_JBOD_SUPPORTED);200 init->r7.host_rrq_addr_high =201 cpu_to_le32(upper_32_bits(dev->host_rrq_pa));202 init->r7.host_rrq_addr_low =203 cpu_to_le32(lower_32_bits(dev->host_rrq_pa));204 pr_warn("aacraid: Comm Interface type1 enabled\n");205 } else if (dev->comm_interface == AAC_COMM_MESSAGE_TYPE2) {206 init->r7.init_struct_revision =207 cpu_to_le32(ADAPTER_INIT_STRUCT_REVISION_7);208 init->r7.init_flags |=209 cpu_to_le32(INITFLAGS_NEW_COMM_SUPPORTED |210 INITFLAGS_NEW_COMM_TYPE2_SUPPORTED |211 INITFLAGS_FAST_JBOD_SUPPORTED);212 init->r7.host_rrq_addr_high =213 cpu_to_le32(upper_32_bits(dev->host_rrq_pa));214 init->r7.host_rrq_addr_low =215 cpu_to_le32(lower_32_bits(dev->host_rrq_pa));216 init->r7.no_of_msix_vectors =217 cpu_to_le32(dev->max_msix);218 /* must be the COMM_PREFERRED_SETTINGS values */219 pr_warn("aacraid: Comm Interface type2 enabled\n");220 }221 }222 223 /*224 * Increment the base address by the amount already used225 */226 base = base + fibsize + host_rrq_size + aac_init_size;227 phys = (dma_addr_t)((ulong)phys + fibsize + host_rrq_size +228 aac_init_size);229 230 /*231 * Align the beginning of Headers to commalign232 */233 align = (commalign - ((uintptr_t)(base) & (commalign - 1)));234 base = base + align;235 phys = phys + align;236 /*237 * Fill in addresses of the Comm Area Headers and Queues238 */239 *commaddr = base;240 if (dev->comm_interface != AAC_COMM_MESSAGE_TYPE3)241 init->r7.comm_header_address = cpu_to_le32((u32)phys);242 /*243 * Increment the base address by the size of the CommArea244 */245 base = base + commsize;246 phys = phys + commsize;247 /*248 * Place the Printf buffer area after the Fast I/O comm area.249 */250 dev->printfbuf = (void *)base;251 if (dev->comm_interface != AAC_COMM_MESSAGE_TYPE3) {252 init->r7.printfbuf = cpu_to_le32(phys);253 init->r7.printfbufsiz = cpu_to_le32(printfbufsiz);254 }255 memset(base, 0, printfbufsiz);256 return 1;257}258 259static void aac_queue_init(struct aac_dev * dev, struct aac_queue * q, u32 *mem, int qsize)260{261 atomic_set(&q->numpending, 0);262 q->dev = dev;263 init_waitqueue_head(&q->cmdready);264 INIT_LIST_HEAD(&q->cmdq);265 init_waitqueue_head(&q->qfull);266 spin_lock_init(&q->lockdata);267 q->lock = &q->lockdata;268 q->headers.producer = (__le32 *)mem;269 q->headers.consumer = (__le32 *)(mem+1);270 *(q->headers.producer) = cpu_to_le32(qsize);271 *(q->headers.consumer) = cpu_to_le32(qsize);272 q->entries = qsize;273}274 275static bool wait_for_io_iter(struct scsi_cmnd *cmd, void *data)276{277 int *active = data;278 279 if (aac_priv(cmd)->owner == AAC_OWNER_FIRMWARE)280 *active = *active + 1;281 return true;282}283static void aac_wait_for_io_completion(struct aac_dev *aac)284{285 int i = 0, active;286 287 for (i = 60; i; --i) {288 289 active = 0;290 scsi_host_busy_iter(aac->scsi_host_ptr,291 wait_for_io_iter, &active);292 /*293 * We can exit If all the commands are complete294 */295 if (active == 0)296 break;297 dev_info(&aac->pdev->dev,298 "Wait for %d commands to complete\n", active);299 ssleep(1);300 }301 if (active)302 dev_err(&aac->pdev->dev,303 "%d outstanding commands during shutdown\n", active);304}305 306/**307 * aac_send_shutdown - shutdown an adapter308 * @dev: Adapter to shutdown309 *310 * This routine will send a VM_CloseAll (shutdown) request to the adapter.311 */312 313int aac_send_shutdown(struct aac_dev * dev)314{315 struct fib * fibctx;316 struct aac_close *cmd;317 int status = 0;318 319 if (aac_adapter_check_health(dev))320 return status;321 322 if (!dev->adapter_shutdown) {323 mutex_lock(&dev->ioctl_mutex);324 dev->adapter_shutdown = 1;325 mutex_unlock(&dev->ioctl_mutex);326 }327 328 aac_wait_for_io_completion(dev);329 330 fibctx = aac_fib_alloc(dev);331 if (!fibctx)332 return -ENOMEM;333 aac_fib_init(fibctx);334 335 cmd = (struct aac_close *) fib_data(fibctx);336 cmd->command = cpu_to_le32(VM_CloseAll);337 cmd->cid = cpu_to_le32(0xfffffffe);338 339 status = aac_fib_send(ContainerCommand,340 fibctx,341 sizeof(struct aac_close),342 FsaNormal,343 -2 /* Timeout silently */, 1,344 NULL, NULL);345 346 if (status >= 0)347 aac_fib_complete(fibctx);348 /* FIB should be freed only after getting the response from the F/W */349 if (status != -ERESTARTSYS)350 aac_fib_free(fibctx);351 if (aac_is_src(dev) &&352 dev->msi_enabled)353 aac_set_intx_mode(dev);354 return status;355}356 357/**358 * aac_comm_init - Initialise FSA data structures359 * @dev: Adapter to initialise360 *361 * Initializes the data structures that are required for the FSA commuication362 * interface to operate. 363 * Returns364 * 1 - if we were able to init the commuication interface.365 * 0 - If there were errors initing. This is a fatal error.366 */367 368static int aac_comm_init(struct aac_dev * dev)369{370 unsigned long hdrsize = (sizeof(u32) * NUMBER_OF_COMM_QUEUES) * 2;371 unsigned long queuesize = sizeof(struct aac_entry) * TOTAL_QUEUE_ENTRIES;372 u32 *headers;373 struct aac_entry * queues;374 unsigned long size;375 struct aac_queue_block * comm = dev->queues;376 /*377 * Now allocate and initialize the zone structures used as our 378 * pool of FIB context records. The size of the zone is based379 * on the system memory size. We also initialize the mutex used380 * to protect the zone.381 */382 spin_lock_init(&dev->fib_lock);383 384 /*385 * Allocate the physically contiguous space for the commuication386 * queue headers. 387 */388 389 size = hdrsize + queuesize;390 391 if (!aac_alloc_comm(dev, (void * *)&headers, size, QUEUE_ALIGNMENT))392 return -ENOMEM;393 394 queues = (struct aac_entry *)(((ulong)headers) + hdrsize);395 396 /* Adapter to Host normal priority Command queue */ 397 comm->queue[HostNormCmdQueue].base = queues;398 aac_queue_init(dev, &comm->queue[HostNormCmdQueue], headers, HOST_NORM_CMD_ENTRIES);399 queues += HOST_NORM_CMD_ENTRIES;400 headers += 2;401 402 /* Adapter to Host high priority command queue */403 comm->queue[HostHighCmdQueue].base = queues;404 aac_queue_init(dev, &comm->queue[HostHighCmdQueue], headers, HOST_HIGH_CMD_ENTRIES);405 406 queues += HOST_HIGH_CMD_ENTRIES;407 headers +=2;408 409 /* Host to adapter normal priority command queue */410 comm->queue[AdapNormCmdQueue].base = queues;411 aac_queue_init(dev, &comm->queue[AdapNormCmdQueue], headers, ADAP_NORM_CMD_ENTRIES);412 413 queues += ADAP_NORM_CMD_ENTRIES;414 headers += 2;415 416 /* host to adapter high priority command queue */417 comm->queue[AdapHighCmdQueue].base = queues;418 aac_queue_init(dev, &comm->queue[AdapHighCmdQueue], headers, ADAP_HIGH_CMD_ENTRIES);419 420 queues += ADAP_HIGH_CMD_ENTRIES;421 headers += 2;422 423 /* adapter to host normal priority response queue */424 comm->queue[HostNormRespQueue].base = queues;425 aac_queue_init(dev, &comm->queue[HostNormRespQueue], headers, HOST_NORM_RESP_ENTRIES);426 queues += HOST_NORM_RESP_ENTRIES;427 headers += 2;428 429 /* adapter to host high priority response queue */430 comm->queue[HostHighRespQueue].base = queues;431 aac_queue_init(dev, &comm->queue[HostHighRespQueue], headers, HOST_HIGH_RESP_ENTRIES);432 433 queues += HOST_HIGH_RESP_ENTRIES;434 headers += 2;435 436 /* host to adapter normal priority response queue */437 comm->queue[AdapNormRespQueue].base = queues;438 aac_queue_init(dev, &comm->queue[AdapNormRespQueue], headers, ADAP_NORM_RESP_ENTRIES);439 440 queues += ADAP_NORM_RESP_ENTRIES;441 headers += 2;442 443 /* host to adapter high priority response queue */ 444 comm->queue[AdapHighRespQueue].base = queues;445 aac_queue_init(dev, &comm->queue[AdapHighRespQueue], headers, ADAP_HIGH_RESP_ENTRIES);446 447 comm->queue[AdapNormCmdQueue].lock = comm->queue[HostNormRespQueue].lock;448 comm->queue[AdapHighCmdQueue].lock = comm->queue[HostHighRespQueue].lock;449 comm->queue[AdapNormRespQueue].lock = comm->queue[HostNormCmdQueue].lock;450 comm->queue[AdapHighRespQueue].lock = comm->queue[HostHighCmdQueue].lock;451 452 return 0;453}454 455void aac_define_int_mode(struct aac_dev *dev)456{457 int i, msi_count, min_msix;458 459 msi_count = i = 0;460 /* max. vectors from GET_COMM_PREFERRED_SETTINGS */461 if (dev->max_msix == 0 ||462 dev->pdev->device == PMC_DEVICE_S6 ||463 dev->sync_mode) {464 dev->max_msix = 1;465 dev->vector_cap =466 dev->scsi_host_ptr->can_queue +467 AAC_NUM_MGT_FIB;468 return;469 }470 471 /* Don't bother allocating more MSI-X vectors than cpus */472 msi_count = min(dev->max_msix,473 (unsigned int)num_online_cpus());474 475 dev->max_msix = msi_count;476 477 if (msi_count > AAC_MAX_MSIX)478 msi_count = AAC_MAX_MSIX;479 480 if (msi_count > 1 &&481 pci_find_capability(dev->pdev, PCI_CAP_ID_MSIX)) {482 min_msix = 2;483 i = pci_alloc_irq_vectors(dev->pdev,484 min_msix, msi_count,485 PCI_IRQ_MSIX | PCI_IRQ_AFFINITY);486 if (i > 0) {487 dev->msi_enabled = 1;488 msi_count = i;489 } else {490 dev->msi_enabled = 0;491 dev_err(&dev->pdev->dev,492 "MSIX not supported!! Will try INTX 0x%x.\n", i);493 }494 }495 496 if (!dev->msi_enabled)497 dev->max_msix = msi_count = 1;498 else {499 if (dev->max_msix > msi_count)500 dev->max_msix = msi_count;501 }502 if (dev->comm_interface == AAC_COMM_MESSAGE_TYPE3 && dev->sa_firmware)503 dev->vector_cap = dev->scsi_host_ptr->can_queue +504 AAC_NUM_MGT_FIB;505 else506 dev->vector_cap = (dev->scsi_host_ptr->can_queue +507 AAC_NUM_MGT_FIB) / msi_count;508 509}510struct aac_dev *aac_init_adapter(struct aac_dev *dev)511{512 u32 status[5];513 struct Scsi_Host * host = dev->scsi_host_ptr;514 extern int aac_sync_mode;515 516 /*517 * Check the preferred comm settings, defaults from template.518 */519 dev->management_fib_count = 0;520 spin_lock_init(&dev->manage_lock);521 spin_lock_init(&dev->sync_lock);522 spin_lock_init(&dev->iq_lock);523 dev->max_fib_size = sizeof(struct hw_fib);524 dev->sg_tablesize = host->sg_tablesize = (dev->max_fib_size525 - sizeof(struct aac_fibhdr) - sizeof(struct aac_write))526 / sizeof(struct sgentry);527 dev->comm_interface = AAC_COMM_PRODUCER;528 dev->raw_io_interface = dev->raw_io_64 = 0;529 530 531 /*532 * Enable INTX mode, if not done already Enabled533 */534 if (aac_is_msix_mode(dev)) {535 aac_change_to_intx(dev);536 dev_info(&dev->pdev->dev, "Changed firmware to INTX mode");537 }538 539 if ((!aac_adapter_sync_cmd(dev, GET_ADAPTER_PROPERTIES,540 0, 0, 0, 0, 0, 0,541 status+0, status+1, status+2, status+3, status+4)) &&542 (status[0] == 0x00000001)) {543 dev->doorbell_mask = status[3];544 if (status[1] & AAC_OPT_NEW_COMM_64)545 dev->raw_io_64 = 1;546 dev->sync_mode = aac_sync_mode;547 if (dev->a_ops.adapter_comm &&548 (status[1] & AAC_OPT_NEW_COMM)) {549 dev->comm_interface = AAC_COMM_MESSAGE;550 dev->raw_io_interface = 1;551 if ((status[1] & AAC_OPT_NEW_COMM_TYPE1)) {552 /* driver supports TYPE1 (Tupelo) */553 dev->comm_interface = AAC_COMM_MESSAGE_TYPE1;554 } else if (status[1] & AAC_OPT_NEW_COMM_TYPE2) {555 /* driver supports TYPE2 (Denali, Yosemite) */556 dev->comm_interface = AAC_COMM_MESSAGE_TYPE2;557 } else if (status[1] & AAC_OPT_NEW_COMM_TYPE3) {558 /* driver supports TYPE3 (Yosemite, Thor) */559 dev->comm_interface = AAC_COMM_MESSAGE_TYPE3;560 } else if (status[1] & AAC_OPT_NEW_COMM_TYPE4) {561 /* not supported TYPE - switch to sync. mode */562 dev->comm_interface = AAC_COMM_MESSAGE_TYPE2;563 dev->sync_mode = 1;564 }565 }566 if ((status[1] & le32_to_cpu(AAC_OPT_EXTENDED)) &&567 (status[4] & le32_to_cpu(AAC_EXTOPT_SA_FIRMWARE)))568 dev->sa_firmware = 1;569 else570 dev->sa_firmware = 0;571 572 if (status[4] & le32_to_cpu(AAC_EXTOPT_SOFT_RESET))573 dev->soft_reset_support = 1;574 else575 dev->soft_reset_support = 0;576 577 if ((dev->comm_interface == AAC_COMM_MESSAGE) &&578 (status[2] > dev->base_size)) {579 aac_adapter_ioremap(dev, 0);580 dev->base_size = status[2];581 if (aac_adapter_ioremap(dev, status[2])) {582 /* remap failed, go back ... */583 dev->comm_interface = AAC_COMM_PRODUCER;584 if (aac_adapter_ioremap(dev, AAC_MIN_FOOTPRINT_SIZE)) {585 printk(KERN_WARNING586 "aacraid: unable to map adapter.\n");587 return NULL;588 }589 }590 }591 }592 dev->max_msix = 0;593 dev->msi_enabled = 0;594 dev->adapter_shutdown = 0;595 if ((!aac_adapter_sync_cmd(dev, GET_COMM_PREFERRED_SETTINGS,596 0, 0, 0, 0, 0, 0,597 status+0, status+1, status+2, status+3, status+4))598 && (status[0] == 0x00000001)) {599 /*600 * status[1] >> 16 maximum command size in KB601 * status[1] & 0xFFFF maximum FIB size602 * status[2] >> 16 maximum SG elements to driver603 * status[2] & 0xFFFF maximum SG elements from driver604 * status[3] & 0xFFFF maximum number FIBs outstanding605 */606 host->max_sectors = (status[1] >> 16) << 1;607 /* Multiple of 32 for PMC */608 dev->max_fib_size = status[1] & 0xFFE0;609 host->sg_tablesize = status[2] >> 16;610 dev->sg_tablesize = status[2] & 0xFFFF;611 if (aac_is_src(dev)) {612 if (host->can_queue > (status[3] >> 16) -613 AAC_NUM_MGT_FIB)614 host->can_queue = (status[3] >> 16) -615 AAC_NUM_MGT_FIB;616 } else if (host->can_queue > (status[3] & 0xFFFF) -617 AAC_NUM_MGT_FIB)618 host->can_queue = (status[3] & 0xFFFF) -619 AAC_NUM_MGT_FIB;620 621 dev->max_num_aif = status[4] & 0xFFFF;622 }623 if (numacb > 0) {624 if (numacb < host->can_queue)625 host->can_queue = numacb;626 else627 pr_warn("numacb=%d ignored\n", numacb);628 }629 630 if (aac_is_src(dev))631 aac_define_int_mode(dev);632 /*633 * Ok now init the communication subsystem634 */635 636 dev->queues = kzalloc(sizeof(struct aac_queue_block), GFP_KERNEL);637 if (dev->queues == NULL) {638 printk(KERN_ERR "Error could not allocate comm region.\n");639 return NULL;640 }641 642 if (aac_comm_init(dev)<0){643 kfree(dev->queues);644 dev->queues = NULL;645 return NULL;646 }647 /*648 * Initialize the list of fibs649 */650 if (aac_fib_setup(dev) < 0) {651 kfree(dev->queues);652 dev->queues = NULL;653 return NULL;654 }655 656 INIT_LIST_HEAD(&dev->fib_list);657 INIT_LIST_HEAD(&dev->sync_fib_list);658 659 return dev;660}661 662