WIP FPC-III support
[linux/fpc-iii.git] / drivers / scsi / aacraid / comminit.c
blob355b16f0b1456bd2683f03b1578e53ef7047f225
1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3 * Adaptec AAC series RAID controller driver
4 * (c) Copyright 2001 Red Hat Inc.
6 * based on the old aacraid driver that is..
7 * Adaptec aacraid device driver for Linux.
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)
13 * Module Name:
14 * comminit.c
16 * Abstract: This supports the initialization of the host adapter commuication interface.
17 * This is a platform dependent module for the pci cyclone board.
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>
34 #include "aacraid.h"
36 struct aac_common aac_config = {
37 .irq_mod = 1
40 static inline int aac_is_msix_mode(struct aac_dev *dev)
42 u32 status = 0;
44 if (aac_is_src(dev))
45 status = src_readl(dev, MUnit.OMR);
46 return (status & AAC_INT_MODE_MSIX);
49 static inline void aac_change_to_intx(struct aac_dev *dev)
51 aac_src_access_devreg(dev, AAC_DISABLE_MSIX);
52 aac_src_access_devreg(dev, AAC_ENABLE_INTX);
55 static int aac_alloc_comm(struct aac_dev *dev, void **commaddr, unsigned long commsize, unsigned long commalign)
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;
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_queue
77 + 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);
84 size = fibsize + aac_init_size + commsize + commalign +
85 printfbufsiz + host_rrq_size;
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;
93 dev->comm_addr = (void *)base;
94 dev->comm_phys = phys;
95 dev->comm_size = size;
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);
105 dev->init = (union aac_init *)(base + fibsize + host_rrq_size);
106 dev->init_pa = phys + fibsize + host_rrq_size;
108 init = dev->init;
110 if (dev->comm_interface == AAC_COMM_MESSAGE_TYPE3) {
111 int i;
112 u64 addr;
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;
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;
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);
152 * Adapter Fibs are the first thing allocated so that they
153 * start page aligned
155 dev->aif_base_va = (struct hw_fib *)base;
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));
163 * number of 4k pages of host physical memory. The aacraid fw
164 * needs this number to be less than 4gb worth of pages. New
165 * firmware doesn't have any issues with the mapping system, but
166 * older Firmware did, and had *troubles* dealing with the math
167 * overloading past 32 bits, thus we must limit this field.
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 else
175 init->r7.host_phys_mem_pages =
176 cpu_to_le32(AAC_MAX_HOSTPHYSMEMPAGES);
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);
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");
224 * Increment the base address by the amount already used
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);
231 * Align the beginning of Headers to commalign
233 align = (commalign - ((uintptr_t)(base) & (commalign - 1)));
234 base = base + align;
235 phys = phys + align;
237 * Fill in addresses of the Comm Area Headers and Queues
239 *commaddr = base;
240 if (dev->comm_interface != AAC_COMM_MESSAGE_TYPE3)
241 init->r7.comm_header_address = cpu_to_le32((u32)phys);
243 * Increment the base address by the size of the CommArea
245 base = base + commsize;
246 phys = phys + commsize;
248 * Place the Printf buffer area after the Fast I/O comm area.
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);
255 memset(base, 0, printfbufsiz);
256 return 1;
259 static void aac_queue_init(struct aac_dev * dev, struct aac_queue * q, u32 *mem, int qsize)
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;
275 static bool wait_for_io_iter(struct scsi_cmnd *cmd, void *data, bool rsvd)
277 int *active = data;
279 if (cmd->SCp.phase == AAC_OWNER_FIRMWARE)
280 *active = *active + 1;
281 return true;
283 static void aac_wait_for_io_completion(struct aac_dev *aac)
285 int i = 0, active;
287 for (i = 60; i; --i) {
289 active = 0;
290 scsi_host_busy_iter(aac->scsi_host_ptr,
291 wait_for_io_iter, &active);
293 * We can exit If all the commands are complete
295 if (active == 0)
296 break;
297 dev_info(&aac->pdev->dev,
298 "Wait for %d commands to complete\n", active);
299 ssleep(1);
301 if (active)
302 dev_err(&aac->pdev->dev,
303 "%d outstanding commands during shutdown\n", active);
307 * aac_send_shutdown - shutdown an adapter
308 * @dev: Adapter to shutdown
310 * This routine will send a VM_CloseAll (shutdown) request to the adapter.
313 int aac_send_shutdown(struct aac_dev * dev)
315 struct fib * fibctx;
316 struct aac_close *cmd;
317 int status = 0;
319 if (aac_adapter_check_health(dev))
320 return status;
322 if (!dev->adapter_shutdown) {
323 mutex_lock(&dev->ioctl_mutex);
324 dev->adapter_shutdown = 1;
325 mutex_unlock(&dev->ioctl_mutex);
328 aac_wait_for_io_completion(dev);
330 fibctx = aac_fib_alloc(dev);
331 if (!fibctx)
332 return -ENOMEM;
333 aac_fib_init(fibctx);
335 cmd = (struct aac_close *) fib_data(fibctx);
336 cmd->command = cpu_to_le32(VM_CloseAll);
337 cmd->cid = cpu_to_le32(0xfffffffe);
339 status = aac_fib_send(ContainerCommand,
340 fibctx,
341 sizeof(struct aac_close),
342 FsaNormal,
343 -2 /* Timeout silently */, 1,
344 NULL, NULL);
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;
358 * aac_comm_init - Initialise FSA data structures
359 * @dev: Adapter to initialise
361 * Initializes the data structures that are required for the FSA commuication
362 * interface to operate.
363 * Returns
364 * 1 - if we were able to init the commuication interface.
365 * 0 - If there were errors initing. This is a fatal error.
368 static int aac_comm_init(struct aac_dev * dev)
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;
377 * Now allocate and initialize the zone structures used as our
378 * pool of FIB context records. The size of the zone is based
379 * on the system memory size. We also initialize the mutex used
380 * to protect the zone.
382 spin_lock_init(&dev->fib_lock);
385 * Allocate the physically contiguous space for the commuication
386 * queue headers.
389 size = hdrsize + queuesize;
391 if (!aac_alloc_comm(dev, (void * *)&headers, size, QUEUE_ALIGNMENT))
392 return -ENOMEM;
394 queues = (struct aac_entry *)(((ulong)headers) + hdrsize);
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;
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);
406 queues += HOST_HIGH_CMD_ENTRIES;
407 headers +=2;
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);
413 queues += ADAP_NORM_CMD_ENTRIES;
414 headers += 2;
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);
420 queues += ADAP_HIGH_CMD_ENTRIES;
421 headers += 2;
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;
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);
433 queues += HOST_HIGH_RESP_ENTRIES;
434 headers += 2;
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);
440 queues += ADAP_NORM_RESP_ENTRIES;
441 headers += 2;
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);
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;
452 return 0;
455 void aac_define_int_mode(struct aac_dev *dev)
457 int i, msi_count, min_msix;
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;
471 /* Don't bother allocating more MSI-X vectors than cpus */
472 msi_count = min(dev->max_msix,
473 (unsigned int)num_online_cpus());
475 dev->max_msix = msi_count;
477 if (msi_count > AAC_MAX_MSIX)
478 msi_count = AAC_MAX_MSIX;
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);
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;
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 else
506 dev->vector_cap = (dev->scsi_host_ptr->can_queue +
507 AAC_NUM_MGT_FIB) / msi_count;
510 struct aac_dev *aac_init_adapter(struct aac_dev *dev)
512 u32 status[5];
513 struct Scsi_Host * host = dev->scsi_host_ptr;
514 extern int aac_sync_mode;
517 * Check the preferred comm settings, defaults from template.
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_size
525 - sizeof(struct aac_fibhdr)
526 - sizeof(struct aac_write) + sizeof(struct sgentry))
527 / sizeof(struct sgentry);
528 dev->comm_interface = AAC_COMM_PRODUCER;
529 dev->raw_io_interface = dev->raw_io_64 = 0;
533 * Enable INTX mode, if not done already Enabled
535 if (aac_is_msix_mode(dev)) {
536 aac_change_to_intx(dev);
537 dev_info(&dev->pdev->dev, "Changed firmware to INTX mode");
540 if ((!aac_adapter_sync_cmd(dev, GET_ADAPTER_PROPERTIES,
541 0, 0, 0, 0, 0, 0,
542 status+0, status+1, status+2, status+3, status+4)) &&
543 (status[0] == 0x00000001)) {
544 dev->doorbell_mask = status[3];
545 if (status[1] & AAC_OPT_NEW_COMM_64)
546 dev->raw_io_64 = 1;
547 dev->sync_mode = aac_sync_mode;
548 if (dev->a_ops.adapter_comm &&
549 (status[1] & AAC_OPT_NEW_COMM)) {
550 dev->comm_interface = AAC_COMM_MESSAGE;
551 dev->raw_io_interface = 1;
552 if ((status[1] & AAC_OPT_NEW_COMM_TYPE1)) {
553 /* driver supports TYPE1 (Tupelo) */
554 dev->comm_interface = AAC_COMM_MESSAGE_TYPE1;
555 } else if (status[1] & AAC_OPT_NEW_COMM_TYPE2) {
556 /* driver supports TYPE2 (Denali, Yosemite) */
557 dev->comm_interface = AAC_COMM_MESSAGE_TYPE2;
558 } else if (status[1] & AAC_OPT_NEW_COMM_TYPE3) {
559 /* driver supports TYPE3 (Yosemite, Thor) */
560 dev->comm_interface = AAC_COMM_MESSAGE_TYPE3;
561 } else if (status[1] & AAC_OPT_NEW_COMM_TYPE4) {
562 /* not supported TYPE - switch to sync. mode */
563 dev->comm_interface = AAC_COMM_MESSAGE_TYPE2;
564 dev->sync_mode = 1;
567 if ((status[1] & le32_to_cpu(AAC_OPT_EXTENDED)) &&
568 (status[4] & le32_to_cpu(AAC_EXTOPT_SA_FIRMWARE)))
569 dev->sa_firmware = 1;
570 else
571 dev->sa_firmware = 0;
573 if (status[4] & le32_to_cpu(AAC_EXTOPT_SOFT_RESET))
574 dev->soft_reset_support = 1;
575 else
576 dev->soft_reset_support = 0;
578 if ((dev->comm_interface == AAC_COMM_MESSAGE) &&
579 (status[2] > dev->base_size)) {
580 aac_adapter_ioremap(dev, 0);
581 dev->base_size = status[2];
582 if (aac_adapter_ioremap(dev, status[2])) {
583 /* remap failed, go back ... */
584 dev->comm_interface = AAC_COMM_PRODUCER;
585 if (aac_adapter_ioremap(dev, AAC_MIN_FOOTPRINT_SIZE)) {
586 printk(KERN_WARNING
587 "aacraid: unable to map adapter.\n");
588 return NULL;
593 dev->max_msix = 0;
594 dev->msi_enabled = 0;
595 dev->adapter_shutdown = 0;
596 if ((!aac_adapter_sync_cmd(dev, GET_COMM_PREFERRED_SETTINGS,
597 0, 0, 0, 0, 0, 0,
598 status+0, status+1, status+2, status+3, status+4))
599 && (status[0] == 0x00000001)) {
601 * status[1] >> 16 maximum command size in KB
602 * status[1] & 0xFFFF maximum FIB size
603 * status[2] >> 16 maximum SG elements to driver
604 * status[2] & 0xFFFF maximum SG elements from driver
605 * status[3] & 0xFFFF maximum number FIBs outstanding
607 host->max_sectors = (status[1] >> 16) << 1;
608 /* Multiple of 32 for PMC */
609 dev->max_fib_size = status[1] & 0xFFE0;
610 host->sg_tablesize = status[2] >> 16;
611 dev->sg_tablesize = status[2] & 0xFFFF;
612 if (aac_is_src(dev)) {
613 if (host->can_queue > (status[3] >> 16) -
614 AAC_NUM_MGT_FIB)
615 host->can_queue = (status[3] >> 16) -
616 AAC_NUM_MGT_FIB;
617 } else if (host->can_queue > (status[3] & 0xFFFF) -
618 AAC_NUM_MGT_FIB)
619 host->can_queue = (status[3] & 0xFFFF) -
620 AAC_NUM_MGT_FIB;
622 dev->max_num_aif = status[4] & 0xFFFF;
624 if (numacb > 0) {
625 if (numacb < host->can_queue)
626 host->can_queue = numacb;
627 else
628 pr_warn("numacb=%d ignored\n", numacb);
631 if (aac_is_src(dev))
632 aac_define_int_mode(dev);
634 * Ok now init the communication subsystem
637 dev->queues = kzalloc(sizeof(struct aac_queue_block), GFP_KERNEL);
638 if (dev->queues == NULL) {
639 printk(KERN_ERR "Error could not allocate comm region.\n");
640 return NULL;
643 if (aac_comm_init(dev)<0){
644 kfree(dev->queues);
645 return NULL;
648 * Initialize the list of fibs
650 if (aac_fib_setup(dev) < 0) {
651 kfree(dev->queues);
652 return NULL;
655 INIT_LIST_HEAD(&dev->fib_list);
656 INIT_LIST_HEAD(&dev->sync_fib_list);
658 return dev;