arcmsr_hba.c 100.4 KB
Newer Older
1 2 3 4
/*
*******************************************************************************
**        O.S   : Linux
**   FILE NAME  : arcmsr_hba.c
5
**        BY    : Nick Cheng
6 7 8 9 10 11
**   Description: SCSI RAID Device Driver for
**                ARECA RAID Host adapter
*******************************************************************************
** Copyright (C) 2002 - 2005, Areca Technology Corporation All rights reserved
**
**     Web site: www.areca.com.tw
12
**       E-mail: support@areca.com.tw
13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58
**
** This program is free software; you can redistribute it and/or modify
** it under the terms of the GNU General Public License version 2 as
** published by the Free Software Foundation.
** This program is distributed in the hope that it will be useful,
** but WITHOUT ANY WARRANTY; without even the implied warranty of
** MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
** GNU General Public License for more details.
*******************************************************************************
** Redistribution and use in source and binary forms, with or without
** modification, are permitted provided that the following conditions
** are met:
** 1. Redistributions of source code must retain the above copyright
**    notice, this list of conditions and the following disclaimer.
** 2. Redistributions in binary form must reproduce the above copyright
**    notice, this list of conditions and the following disclaimer in the
**    documentation and/or other materials provided with the distribution.
** 3. The name of the author may not be used to endorse or promote products
**    derived from this software without specific prior written permission.
**
** THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
** IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
** OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
** IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
** INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES(INCLUDING,BUT
** NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
** DATA, OR PROFITS; OR BUSINESS INTERRUPTION)HOWEVER CAUSED AND ON ANY
** THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
** (INCLUDING NEGLIGENCE OR OTHERWISE)ARISING IN ANY WAY OUT OF THE USE OF
** THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
*******************************************************************************
** For history of changes, see Documentation/scsi/ChangeLog.arcmsr
**     Firmware Specification, see Documentation/scsi/arcmsr_spec.txt
*******************************************************************************
*/
#include <linux/module.h>
#include <linux/reboot.h>
#include <linux/spinlock.h>
#include <linux/pci_ids.h>
#include <linux/interrupt.h>
#include <linux/moduleparam.h>
#include <linux/errno.h>
#include <linux/types.h>
#include <linux/delay.h>
#include <linux/dma-mapping.h>
#include <linux/timer.h>
59
#include <linux/slab.h>
60
#include <linux/pci.h>
61
#include <linux/aer.h>
62 63 64 65 66 67 68 69 70 71 72
#include <asm/dma.h>
#include <asm/io.h>
#include <asm/uaccess.h>
#include <scsi/scsi_host.h>
#include <scsi/scsi.h>
#include <scsi/scsi_cmnd.h>
#include <scsi/scsi_tcq.h>
#include <scsi/scsi_device.h>
#include <scsi/scsi_transport.h>
#include <scsi/scsicam.h>
#include "arcmsr.h"
73
MODULE_AUTHOR("Nick Cheng <support@areca.com.tw>");
74
MODULE_DESCRIPTION("ARECA (ARC11xx/12xx/16xx/1880) SATA/SAS RAID Host Bus Adapter");
75 76
MODULE_LICENSE("Dual BSD/GPL");
MODULE_VERSION(ARCMSR_DRIVER_VERSION);
77 78 79 80

#define	ARCMSR_SLEEPTIME	10
#define	ARCMSR_RETRYCOUNT	12

81
wait_queue_head_t wait_q;
82 83 84
static int arcmsr_iop_message_xfer(struct AdapterControlBlock *acb,
					struct scsi_cmnd *cmd);
static int arcmsr_iop_confirm(struct AdapterControlBlock *acb);
85 86 87
static int arcmsr_abort(struct scsi_cmnd *);
static int arcmsr_bus_reset(struct scsi_cmnd *);
static int arcmsr_bios_param(struct scsi_device *sdev,
88
		struct block_device *bdev, sector_t capacity, int *info);
J
Jeff Garzik 已提交
89
static int arcmsr_queue_command(struct Scsi_Host *h, struct scsi_cmnd *cmd);
90 91
static int arcmsr_probe(struct pci_dev *pdev,
				const struct pci_device_id *id);
92 93
static int arcmsr_suspend(struct pci_dev *pdev, pm_message_t state);
static int arcmsr_resume(struct pci_dev *pdev);
94 95 96 97
static void arcmsr_remove(struct pci_dev *pdev);
static void arcmsr_shutdown(struct pci_dev *pdev);
static void arcmsr_iop_init(struct AdapterControlBlock *acb);
static void arcmsr_free_ccb_pool(struct AdapterControlBlock *acb);
98
static u32 arcmsr_disable_outbound_ints(struct AdapterControlBlock *acb);
99 100
static void arcmsr_enable_outbound_ints(struct AdapterControlBlock *acb,
	u32 intmask_org);
101
static void arcmsr_stop_adapter_bgrb(struct AdapterControlBlock *acb);
102 103
static void arcmsr_hbaA_flush_cache(struct AdapterControlBlock *acb);
static void arcmsr_hbaB_flush_cache(struct AdapterControlBlock *acb);
104
static void arcmsr_request_device_map(unsigned long pacb);
105 106 107
static void arcmsr_hbaA_request_device_map(struct AdapterControlBlock *acb);
static void arcmsr_hbaB_request_device_map(struct AdapterControlBlock *acb);
static void arcmsr_hbaC_request_device_map(struct AdapterControlBlock *acb);
108
static void arcmsr_message_isr_bh_fn(struct work_struct *work);
109
static bool arcmsr_get_firmware_spec(struct AdapterControlBlock *acb);
110
static void arcmsr_start_adapter_bgrb(struct AdapterControlBlock *acb);
111
static void arcmsr_hbaC_message_isr(struct AdapterControlBlock *pACB);
112
static void arcmsr_hardware_reset(struct AdapterControlBlock *acb);
113 114
static const char *arcmsr_info(struct Scsi_Host *);
static irqreturn_t arcmsr_interrupt(struct AdapterControlBlock *acb);
115
static int arcmsr_adjust_disk_queue_depth(struct scsi_device *sdev,
116
					  int queue_depth, int reason)
117
{
118 119 120
	if (reason != SCSI_QDEPTH_DEFAULT)
		return -EOPNOTSUPP;

121 122 123 124 125 126 127 128
	if (queue_depth > ARCMSR_MAX_CMD_PERLUN)
		queue_depth = ARCMSR_MAX_CMD_PERLUN;
	scsi_adjust_queue_depth(sdev, MSG_ORDERED_TAG, queue_depth);
	return queue_depth;
}

static struct scsi_host_template arcmsr_scsi_host_template = {
	.module			= THIS_MODULE,
129 130
	.name			= "ARCMSR ARECA SATA/SAS RAID Controller"
				ARCMSR_DRIVER_VERSION,
131 132
	.info			= arcmsr_info,
	.queuecommand		= arcmsr_queue_command,
133
	.eh_abort_handler		= arcmsr_abort,
134 135 136
	.eh_bus_reset_handler	= arcmsr_bus_reset,
	.bios_param		= arcmsr_bios_param,
	.change_queue_depth	= arcmsr_adjust_disk_queue_depth,
137
	.can_queue		= ARCMSR_MAX_OUTSTANDING_CMD,
138 139 140
	.this_id			= ARCMSR_SCSI_INITIATOR_ID,
	.sg_tablesize	        	= ARCMSR_DEFAULT_SG_ENTRIES, 
	.max_sectors    	    	= ARCMSR_MAX_XFER_SECTORS_C, 
141 142 143
	.cmd_per_lun		= ARCMSR_MAX_CMD_PERLUN,
	.use_clustering		= ENABLE_CLUSTERING,
	.shost_attrs		= arcmsr_host_attrs,
144
	.no_write_same		= 1,
145
};
146

147
static struct pci_device_id arcmsr_device_id_table[] = {
148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185
	{PCI_DEVICE(PCI_VENDOR_ID_ARECA, PCI_DEVICE_ID_ARECA_1110),
		.driver_data = ACB_ADAPTER_TYPE_A},
	{PCI_DEVICE(PCI_VENDOR_ID_ARECA, PCI_DEVICE_ID_ARECA_1120),
		.driver_data = ACB_ADAPTER_TYPE_A},
	{PCI_DEVICE(PCI_VENDOR_ID_ARECA, PCI_DEVICE_ID_ARECA_1130),
		.driver_data = ACB_ADAPTER_TYPE_A},
	{PCI_DEVICE(PCI_VENDOR_ID_ARECA, PCI_DEVICE_ID_ARECA_1160),
		.driver_data = ACB_ADAPTER_TYPE_A},
	{PCI_DEVICE(PCI_VENDOR_ID_ARECA, PCI_DEVICE_ID_ARECA_1170),
		.driver_data = ACB_ADAPTER_TYPE_A},
	{PCI_DEVICE(PCI_VENDOR_ID_ARECA, PCI_DEVICE_ID_ARECA_1200),
		.driver_data = ACB_ADAPTER_TYPE_B},
	{PCI_DEVICE(PCI_VENDOR_ID_ARECA, PCI_DEVICE_ID_ARECA_1201),
		.driver_data = ACB_ADAPTER_TYPE_B},
	{PCI_DEVICE(PCI_VENDOR_ID_ARECA, PCI_DEVICE_ID_ARECA_1202),
		.driver_data = ACB_ADAPTER_TYPE_B},
	{PCI_DEVICE(PCI_VENDOR_ID_ARECA, PCI_DEVICE_ID_ARECA_1210),
		.driver_data = ACB_ADAPTER_TYPE_A},
	{PCI_DEVICE(PCI_VENDOR_ID_ARECA, PCI_DEVICE_ID_ARECA_1220),
		.driver_data = ACB_ADAPTER_TYPE_A},
	{PCI_DEVICE(PCI_VENDOR_ID_ARECA, PCI_DEVICE_ID_ARECA_1230),
		.driver_data = ACB_ADAPTER_TYPE_A},
	{PCI_DEVICE(PCI_VENDOR_ID_ARECA, PCI_DEVICE_ID_ARECA_1260),
		.driver_data = ACB_ADAPTER_TYPE_A},
	{PCI_DEVICE(PCI_VENDOR_ID_ARECA, PCI_DEVICE_ID_ARECA_1270),
		.driver_data = ACB_ADAPTER_TYPE_A},
	{PCI_DEVICE(PCI_VENDOR_ID_ARECA, PCI_DEVICE_ID_ARECA_1280),
		.driver_data = ACB_ADAPTER_TYPE_A},
	{PCI_DEVICE(PCI_VENDOR_ID_ARECA, PCI_DEVICE_ID_ARECA_1380),
		.driver_data = ACB_ADAPTER_TYPE_A},
	{PCI_DEVICE(PCI_VENDOR_ID_ARECA, PCI_DEVICE_ID_ARECA_1381),
		.driver_data = ACB_ADAPTER_TYPE_A},
	{PCI_DEVICE(PCI_VENDOR_ID_ARECA, PCI_DEVICE_ID_ARECA_1680),
		.driver_data = ACB_ADAPTER_TYPE_A},
	{PCI_DEVICE(PCI_VENDOR_ID_ARECA, PCI_DEVICE_ID_ARECA_1681),
		.driver_data = ACB_ADAPTER_TYPE_A},
	{PCI_DEVICE(PCI_VENDOR_ID_ARECA, PCI_DEVICE_ID_ARECA_1880),
		.driver_data = ACB_ADAPTER_TYPE_C},
186 187 188
	{0, 0}, /* Terminating entry */
};
MODULE_DEVICE_TABLE(pci, arcmsr_device_id_table);
189

190 191
static struct pci_driver arcmsr_pci_driver = {
	.name			= "arcmsr",
192
	.id_table			= arcmsr_device_id_table,
193 194
	.probe			= arcmsr_probe,
	.remove			= arcmsr_remove,
195 196
	.suspend		= arcmsr_suspend,
	.resume			= arcmsr_resume,
197
	.shutdown		= arcmsr_shutdown,
198
};
199 200 201 202
/*
****************************************************************************
****************************************************************************
*/
203

204
static void arcmsr_free_mu(struct AdapterControlBlock *acb)
205 206 207
{
	switch (acb->adapter_type) {
	case ACB_ADAPTER_TYPE_A:
208
	case ACB_ADAPTER_TYPE_C:
209 210
		break;
	case ACB_ADAPTER_TYPE_B:{
211 212
		dma_free_coherent(&acb->pdev->dev,
			sizeof(struct MessageUnit_B),
213
			acb->pmuB, acb->dma_coherent_handle2);
214 215 216 217 218 219 220
	}
	}
}

static bool arcmsr_remap_pciregion(struct AdapterControlBlock *acb)
{
	struct pci_dev *pdev = acb->pdev;
221
	switch (acb->adapter_type){
222
	case ACB_ADAPTER_TYPE_A:{
223
		acb->pmuA = ioremap(pci_resource_start(pdev,0), pci_resource_len(pdev,0));
224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244
		if (!acb->pmuA) {
			printk(KERN_NOTICE "arcmsr%d: memory mapping region fail \n", acb->host->host_no);
			return false;
		}
		break;
	}
	case ACB_ADAPTER_TYPE_B:{
		void __iomem *mem_base0, *mem_base1;
		mem_base0 = ioremap(pci_resource_start(pdev, 0), pci_resource_len(pdev, 0));
		if (!mem_base0) {
			printk(KERN_NOTICE "arcmsr%d: memory mapping region fail \n", acb->host->host_no);
			return false;
		}
		mem_base1 = ioremap(pci_resource_start(pdev, 2), pci_resource_len(pdev, 2));
		if (!mem_base1) {
			iounmap(mem_base0);
			printk(KERN_NOTICE "arcmsr%d: memory mapping region fail \n", acb->host->host_no);
			return false;
		}
		acb->mem_base0 = mem_base0;
		acb->mem_base1 = mem_base1;
245 246 247 248 249 250 251 252 253 254 255 256 257
		break;
	}
	case ACB_ADAPTER_TYPE_C:{
		acb->pmuC = ioremap_nocache(pci_resource_start(pdev, 1), pci_resource_len(pdev, 1));
		if (!acb->pmuC) {
			printk(KERN_NOTICE "arcmsr%d: memory mapping region fail \n", acb->host->host_no);
			return false;
		}
		if (readl(&acb->pmuC->outbound_doorbell) & ARCMSR_HBCMU_IOP2DRV_MESSAGE_CMD_DONE) {
			writel(ARCMSR_HBCMU_IOP2DRV_MESSAGE_CMD_DONE_DOORBELL_CLEAR, &acb->pmuC->outbound_doorbell_clear);/*clear interrupt*/
			return true;
		}
		break;
258 259 260 261 262 263 264 265
	}
	}
	return true;
}

static void arcmsr_unmap_pciregion(struct AdapterControlBlock *acb)
{
	switch (acb->adapter_type) {
266 267 268 269 270 271 272 273 274 275 276 277 278
	case ACB_ADAPTER_TYPE_A:{
		iounmap(acb->pmuA);
	}
	break;
	case ACB_ADAPTER_TYPE_B:{
		iounmap(acb->mem_base0);
		iounmap(acb->mem_base1);
	}

	break;
	case ACB_ADAPTER_TYPE_C:{
		iounmap(acb->pmuC);
	}
279 280 281
	}
}

282
static irqreturn_t arcmsr_do_interrupt(int irq, void *dev_id)
283 284
{
	irqreturn_t handle_state;
285
	struct AdapterControlBlock *acb = dev_id;
286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318

	handle_state = arcmsr_interrupt(acb);
	return handle_state;
}

static int arcmsr_bios_param(struct scsi_device *sdev,
		struct block_device *bdev, sector_t capacity, int *geom)
{
	int ret, heads, sectors, cylinders, total_capacity;
	unsigned char *buffer;/* return copy of block device's partition table */

	buffer = scsi_bios_ptable(bdev);
	if (buffer) {
		ret = scsi_partsize(buffer, capacity, &geom[2], &geom[0], &geom[1]);
		kfree(buffer);
		if (ret != -1)
			return ret;
	}
	total_capacity = capacity;
	heads = 64;
	sectors = 32;
	cylinders = total_capacity / (heads * sectors);
	if (cylinders > 1024) {
		heads = 255;
		sectors = 63;
		cylinders = total_capacity / (heads * sectors);
	}
	geom[0] = heads;
	geom[1] = sectors;
	geom[2] = cylinders;
	return 0;
}

319
static uint8_t arcmsr_hbaA_wait_msgint_ready(struct AdapterControlBlock *acb)
320 321
{
	struct MessageUnit_A __iomem *reg = acb->pmuA;
322 323 324 325 326 327 328 329 330 331 332
	int i;

	for (i = 0; i < 2000; i++) {
		if (readl(&reg->outbound_intstatus) &
				ARCMSR_MU_OUTBOUND_MESSAGE0_INT) {
			writel(ARCMSR_MU_OUTBOUND_MESSAGE0_INT,
				&reg->outbound_intstatus);
			return true;
		}
		msleep(10);
	} /* max 20 seconds */
333

334
	return false;
335 336
}

337
static uint8_t arcmsr_hbaB_wait_msgint_ready(struct AdapterControlBlock *acb)
338
{
339
	struct MessageUnit_B *reg = acb->pmuB;
340 341 342 343 344 345 346 347 348 349 350 351 352
	int i;

	for (i = 0; i < 2000; i++) {
		if (readl(reg->iop2drv_doorbell)
			& ARCMSR_IOP2DRV_MESSAGE_CMD_DONE) {
			writel(ARCMSR_MESSAGE_INT_CLEAR_PATTERN,
					reg->iop2drv_doorbell);
			writel(ARCMSR_DRV2IOP_END_OF_INTERRUPT,
					reg->drv2iop_doorbell);
			return true;
		}
		msleep(10);
	} /* max 20 seconds */
353

354
	return false;
355 356
}

357
static uint8_t arcmsr_hbaC_wait_msgint_ready(struct AdapterControlBlock *pACB)
358 359
{
	struct MessageUnit_C *phbcmu = (struct MessageUnit_C *)pACB->pmuC;
360 361 362 363 364 365 366 367 368 369 370 371
	int i;

	for (i = 0; i < 2000; i++) {
		if (readl(&phbcmu->outbound_doorbell)
				& ARCMSR_HBCMU_IOP2DRV_MESSAGE_CMD_DONE) {
			writel(ARCMSR_HBCMU_IOP2DRV_MESSAGE_CMD_DONE_DOORBELL_CLEAR,
				&phbcmu->outbound_doorbell_clear); /*clear interrupt*/
			return true;
		}
		msleep(10);
	} /* max 20 seconds */

372 373
	return false;
}
374

375
static void arcmsr_hbaA_flush_cache(struct AdapterControlBlock *acb)
376 377 378 379 380
{
	struct MessageUnit_A __iomem *reg = acb->pmuA;
	int retry_count = 30;
	writel(ARCMSR_INBOUND_MESG0_FLUSH_CACHE, &reg->inbound_msgaddr0);
	do {
381
		if (arcmsr_hbaA_wait_msgint_ready(acb))
382 383 384 385 386 387 388 389 390
			break;
		else {
			retry_count--;
			printk(KERN_NOTICE "arcmsr%d: wait 'flush adapter cache' \
			timeout, retry count down = %d \n", acb->host->host_no, retry_count);
		}
	} while (retry_count != 0);
}

391
static void arcmsr_hbaB_flush_cache(struct AdapterControlBlock *acb)
392 393 394 395 396
{
	struct MessageUnit_B *reg = acb->pmuB;
	int retry_count = 30;
	writel(ARCMSR_MESSAGE_FLUSH_CACHE, reg->drv2iop_doorbell);
	do {
397
		if (arcmsr_hbaB_wait_msgint_ready(acb))
398 399 400 401 402 403 404 405 406
			break;
		else {
			retry_count--;
			printk(KERN_NOTICE "arcmsr%d: wait 'flush adapter cache' \
			timeout,retry count down = %d \n", acb->host->host_no, retry_count);
		}
	} while (retry_count != 0);
}

407
static void arcmsr_hbaC_flush_cache(struct AdapterControlBlock *pACB)
408 409 410 411 412 413
{
	struct MessageUnit_C *reg = (struct MessageUnit_C *)pACB->pmuC;
	int retry_count = 30;/* enlarge wait flush adapter cache time: 10 minute */
	writel(ARCMSR_INBOUND_MESG0_FLUSH_CACHE, &reg->inbound_msgaddr0);
	writel(ARCMSR_HBCMU_DRV2IOP_MESSAGE_CMD_DONE, &reg->inbound_doorbell);
	do {
414
		if (arcmsr_hbaC_wait_msgint_ready(pACB)) {
415 416 417 418 419 420 421 422 423
			break;
		} else {
			retry_count--;
			printk(KERN_NOTICE "arcmsr%d: wait 'flush adapter cache' \
			timeout,retry count down = %d \n", pACB->host->host_no, retry_count);
		}
	} while (retry_count != 0);
	return;
}
424 425
static void arcmsr_flush_adapter_cache(struct AdapterControlBlock *acb)
{
426
	switch (acb->adapter_type) {
427

428
	case ACB_ADAPTER_TYPE_A: {
429
		arcmsr_hbaA_flush_cache(acb);
430 431
		}
		break;
432

433
	case ACB_ADAPTER_TYPE_B: {
434
		arcmsr_hbaB_flush_cache(acb);
435
		}
436 437
		break;
	case ACB_ADAPTER_TYPE_C: {
438
		arcmsr_hbaC_flush_cache(acb);
439
		}
440 441
	}
}
442

443 444
static int arcmsr_alloc_ccb_pool(struct AdapterControlBlock *acb)
{
445 446 447 448 449 450
	struct pci_dev *pdev = acb->pdev;
	void *dma_coherent;
	dma_addr_t dma_coherent_handle;
	struct CommandControlBlock *ccb_tmp;
	int i = 0, j = 0;
	dma_addr_t cdb_phyaddr;
451
	unsigned long roundup_ccbsize;
452 453 454
	unsigned long max_xfer_len;
	unsigned long max_sg_entrys;
	uint32_t  firm_config_version;
455

456 457 458 459 460 461 462 463 464
	for (i = 0; i < ARCMSR_MAX_TARGETID; i++)
		for (j = 0; j < ARCMSR_MAX_TARGETLUN; j++)
			acb->devstate[i][j] = ARECA_RAID_GONE;

	max_xfer_len = ARCMSR_MAX_XFER_LEN;
	max_sg_entrys = ARCMSR_DEFAULT_SG_ENTRIES;
	firm_config_version = acb->firm_cfg_version;
	if((firm_config_version & 0xFF) >= 3){
		max_xfer_len = (ARCMSR_CDB_SG_PAGE_LENGTH << ((firm_config_version >> 8) & 0xFF)) * 1024;/* max 4M byte */
465
		max_sg_entrys = (max_xfer_len/4096);
466 467 468 469
	}
	acb->host->max_sectors = max_xfer_len/512;
	acb->host->sg_tablesize = max_sg_entrys;
	roundup_ccbsize = roundup(sizeof(struct CommandControlBlock) + (max_sg_entrys - 1) * sizeof(struct SG64ENTRY), 32);
470
	acb->uncache_size = roundup_ccbsize * ARCMSR_MAX_FREECCB_NUM;
471 472
	dma_coherent = dma_alloc_coherent(&pdev->dev, acb->uncache_size, &dma_coherent_handle, GFP_KERNEL);
	if(!dma_coherent){
473
		printk(KERN_NOTICE "arcmsr%d: dma_alloc_coherent got error\n", acb->host->host_no);
474 475 476 477 478 479 480 481 482
		return -ENOMEM;
	}
	acb->dma_coherent = dma_coherent;
	acb->dma_coherent_handle = dma_coherent_handle;
	memset(dma_coherent, 0, acb->uncache_size);
	ccb_tmp = dma_coherent;
	acb->vir2phy_offset = (unsigned long)dma_coherent - (unsigned long)dma_coherent_handle;
	for(i = 0; i < ARCMSR_MAX_FREECCB_NUM; i++){
		cdb_phyaddr = dma_coherent_handle + offsetof(struct CommandControlBlock, arcmsr_cdb);
483 484 485
		ccb_tmp->cdb_phyaddr =
			((acb->adapter_type == ACB_ADAPTER_TYPE_C) ?
			 cdb_phyaddr : (cdb_phyaddr >> 5));
486 487 488 489 490 491
		acb->pccb_pool[i] = ccb_tmp;
		ccb_tmp->acb = acb;
		INIT_LIST_HEAD(&ccb_tmp->list);
		list_add_tail(&ccb_tmp->list, &acb->ccb_free_list);
		ccb_tmp = (struct CommandControlBlock *)((unsigned long)ccb_tmp + roundup_ccbsize);
		dma_coherent_handle = dma_coherent_handle + roundup_ccbsize;
492
	}
493 494
	return 0;
}
495

496 497
static void arcmsr_message_isr_bh_fn(struct work_struct *work) 
{
498 499 500 501 502 503 504 505 506
	struct AdapterControlBlock *acb = container_of(work,
		struct AdapterControlBlock, arcmsr_do_message_isr_bh);
	char *acb_dev_map = (char *)acb->device_map;
	uint32_t __iomem *signature = NULL;
	char __iomem *devicemap = NULL;
	int target, lun;
	struct scsi_device *psdev;
	char diff, temp;

507
	switch (acb->adapter_type) {
508 509
	case ACB_ADAPTER_TYPE_A: {
		struct MessageUnit_A __iomem *reg  = acb->pmuA;
510

511 512
		signature = (uint32_t __iomem *)(&reg->message_rwbuffer[0]);
		devicemap = (char __iomem *)(&reg->message_rwbuffer[21]);
513
		break;
514 515 516 517 518 519 520 521 522 523 524 525 526 527 528 529 530 531 532 533 534 535 536 537 538 539 540 541 542 543 544 545 546 547 548 549 550 551
	}
	case ACB_ADAPTER_TYPE_B: {
		struct MessageUnit_B *reg  = acb->pmuB;

		signature = (uint32_t __iomem *)(&reg->message_rwbuffer[0]);
		devicemap = (char __iomem *)(&reg->message_rwbuffer[21]);
		break;
	}
	case ACB_ADAPTER_TYPE_C: {
		struct MessageUnit_C __iomem *reg  = acb->pmuC;

		signature = (uint32_t __iomem *)(&reg->msgcode_rwbuffer[0]);
		devicemap = (char __iomem *)(&reg->msgcode_rwbuffer[21]);
		break;
	}
	}
	atomic_inc(&acb->rq_map_token);
	if (readl(signature) != ARCMSR_SIGNATURE_GET_CONFIG)
		return;
	for (target = 0; target < ARCMSR_MAX_TARGETID - 1;
		target++) {
		temp = readb(devicemap);
		diff = (*acb_dev_map) ^ temp;
		if (diff != 0) {
			*acb_dev_map = temp;
			for (lun = 0; lun < ARCMSR_MAX_TARGETLUN;
				lun++) {
				if ((diff & 0x01) == 1 &&
					(temp & 0x01) == 1) {
					scsi_add_device(acb->host,
						0, target, lun);
				} else if ((diff & 0x01) == 1
					&& (temp & 0x01) == 0) {
					psdev = scsi_device_lookup(acb->host,
						0, target, lun);
					if (psdev != NULL) {
						scsi_remove_device(psdev);
						scsi_device_put(psdev);
552 553
					}
				}
554 555
				temp >>= 1;
				diff >>= 1;
556 557
			}
		}
558 559
		devicemap++;
		acb_dev_map++;
560 561
	}
}
562

563 564 565 566 567 568 569 570 571 572 573 574 575 576 577 578 579 580 581 582 583 584 585 586 587 588 589 590 591 592 593 594 595 596 597 598 599 600 601 602 603 604 605 606 607 608 609 610 611 612
static int
arcmsr_request_irq(struct pci_dev *pdev, struct AdapterControlBlock *acb)
{
	int	i, j, r;
	struct msix_entry entries[ARCMST_NUM_MSIX_VECTORS];

	for (i = 0; i < ARCMST_NUM_MSIX_VECTORS; i++)
		entries[i].entry = i;
	r = pci_enable_msix_range(pdev, entries, 1, ARCMST_NUM_MSIX_VECTORS);
	if (r < 0)
		goto msi_int;
	acb->msix_vector_count = r;
	for (i = 0; i < r; i++) {
		if (request_irq(entries[i].vector,
			arcmsr_do_interrupt, 0, "arcmsr", acb)) {
			pr_warn("arcmsr%d: request_irq =%d failed!\n",
				acb->host->host_no, entries[i].vector);
			for (j = 0 ; j < i ; j++)
				free_irq(entries[j].vector, acb);
			pci_disable_msix(pdev);
			goto msi_int;
		}
		acb->entries[i] = entries[i];
	}
	acb->acb_flags |= ACB_F_MSIX_ENABLED;
	pr_info("arcmsr%d: msi-x enabled\n", acb->host->host_no);
	return SUCCESS;
msi_int:
	if (pci_enable_msi_exact(pdev, 1) < 0)
		goto legacy_int;
	if (request_irq(pdev->irq, arcmsr_do_interrupt,
		IRQF_SHARED, "arcmsr", acb)) {
		pr_warn("arcmsr%d: request_irq =%d failed!\n",
			acb->host->host_no, pdev->irq);
		pci_disable_msi(pdev);
		goto legacy_int;
	}
	acb->acb_flags |= ACB_F_MSI_ENABLED;
	pr_info("arcmsr%d: msi enabled\n", acb->host->host_no);
	return SUCCESS;
legacy_int:
	if (request_irq(pdev->irq, arcmsr_do_interrupt,
		IRQF_SHARED, "arcmsr", acb)) {
		pr_warn("arcmsr%d: request_irq = %d failed!\n",
			acb->host->host_no, pdev->irq);
		return FAILED;
	}
	return SUCCESS;
}

613
static int arcmsr_probe(struct pci_dev *pdev, const struct pci_device_id *id)
614 615 616
{
	struct Scsi_Host *host;
	struct AdapterControlBlock *acb;
617
	uint8_t bus,dev_fun;
618 619
	int error;
	error = pci_enable_device(pdev);
620
	if(error){
621 622 623
		return -ENODEV;
	}
	host = scsi_host_alloc(&arcmsr_scsi_host_template, sizeof(struct AdapterControlBlock));
624 625
	if(!host){
    		goto pci_disable_dev;
626
	}
627
	error = pci_set_dma_mask(pdev, DMA_BIT_MASK(64));
628
	if(error){
629
		error = pci_set_dma_mask(pdev, DMA_BIT_MASK(32));
630
		if(error){
631 632 633
			printk(KERN_WARNING
			       "scsi%d: No suitable DMA mask available\n",
			       host->host_no);
634
			goto scsi_host_release;
635 636
		}
	}
637
	init_waitqueue_head(&wait_q);
638 639
	bus = pdev->bus->number;
	dev_fun = pdev->devfn;
640
	acb = (struct AdapterControlBlock *) host->hostdata;
641
	memset(acb,0,sizeof(struct AdapterControlBlock));
642
	acb->pdev = pdev;
643
	acb->host = host;
644
	host->max_lun = ARCMSR_MAX_TARGETLUN;
645 646
	host->max_id = ARCMSR_MAX_TARGETID;		/*16:8*/
	host->max_cmd_len = 16;	 			/*this is issue of 64bit LBA ,over 2T byte*/
647
	host->can_queue = ARCMSR_MAX_OUTSTANDING_CMD;
648
	host->cmd_per_lun = ARCMSR_MAX_CMD_PERLUN;	    
649 650
	host->this_id = ARCMSR_SCSI_INITIATOR_ID;
	host->unique_id = (bus << 8) | dev_fun;
651 652
	pci_set_drvdata(pdev, host);
	pci_set_master(pdev);
653
	error = pci_request_regions(pdev, "arcmsr");
654
	if(error){
655
		goto scsi_host_release;
656
	}
657 658
	spin_lock_init(&acb->eh_lock);
	spin_lock_init(&acb->ccblist_lock);
659
	acb->acb_flags |= (ACB_F_MESSAGE_WQBUFFER_CLEARED |
660 661
			ACB_F_MESSAGE_RQBUFFER_CLEARED |
			ACB_F_MESSAGE_WQBUFFER_READED);
662 663
	acb->acb_flags &= ~ACB_F_SCSISTOPADAPTER;
	INIT_LIST_HEAD(&acb->ccb_free_list);
664
	acb->adapter_type = id->driver_data;
665
	error = arcmsr_remap_pciregion(acb);
666
	if(!error){
667 668 669
		goto pci_release_regs;
	}
	error = arcmsr_get_firmware_spec(acb);
670
	if(!error){
671 672
		goto unmap_pci_region;
	}
673
	error = arcmsr_alloc_ccb_pool(acb);
674
	if(error){
675 676
		goto free_hbb_mu;
	}
677
	error = scsi_add_host(host, &pdev->dev);
678
	if(error){
679 680
		goto RAID_controller_stop;
	}
681
	if (arcmsr_request_irq(pdev, acb) == FAILED)
682
		goto scsi_host_remove;
683
	arcmsr_iop_init(acb);
684
    	scsi_scan_host(host);
685
	INIT_WORK(&acb->arcmsr_do_message_isr_bh, arcmsr_message_isr_bh_fn);
686
	atomic_set(&acb->rq_map_token, 16);
687 688
	atomic_set(&acb->ante_token_value, 16);
	acb->fw_flag = FW_NORMAL;
689
	init_timer(&acb->eternal_timer);
690
	acb->eternal_timer.expires = jiffies + msecs_to_jiffies(6 * HZ);
691 692 693
	acb->eternal_timer.data = (unsigned long) acb;
	acb->eternal_timer.function = &arcmsr_request_device_map;
	add_timer(&acb->eternal_timer);
694
	if(arcmsr_alloc_sysfs_attr(acb))
695
		goto out_free_sysfs;
696
	return 0;
697
out_free_sysfs:
698 699 700 701 702
scsi_host_remove:
	scsi_remove_host(host);
RAID_controller_stop:
	arcmsr_stop_adapter_bgrb(acb);
	arcmsr_flush_adapter_cache(acb);
703
	arcmsr_free_ccb_pool(acb);
704
free_hbb_mu:
705
	arcmsr_free_mu(acb);
706 707 708
unmap_pci_region:
	arcmsr_unmap_pciregion(acb);
pci_release_regs:
709
	pci_release_regions(pdev);
710
scsi_host_release:
711
	scsi_host_put(host);
712
pci_disable_dev:
713
	pci_disable_device(pdev);
714
	return -ENODEV;
715 716
}

717 718 719 720 721 722 723 724 725 726 727 728 729 730 731 732
static void arcmsr_free_irq(struct pci_dev *pdev,
		struct AdapterControlBlock *acb)
{
	int i;

	if (acb->acb_flags & ACB_F_MSI_ENABLED) {
		free_irq(pdev->irq, acb);
		pci_disable_msi(pdev);
	} else if (acb->acb_flags & ACB_F_MSIX_ENABLED) {
		for (i = 0; i < acb->msix_vector_count; i++)
			free_irq(acb->entries[i].vector, acb);
		pci_disable_msix(pdev);
	} else
		free_irq(pdev->irq, acb);
}

733 734 735 736 737 738 739 740 741 742 743 744 745 746 747 748 749 750 751 752 753 754 755 756 757 758 759 760 761 762 763 764 765 766 767 768 769 770 771 772 773 774 775 776 777 778 779 780 781 782 783 784 785 786 787 788 789 790 791 792 793 794 795 796 797 798 799 800 801 802
static int arcmsr_suspend(struct pci_dev *pdev, pm_message_t state)
{
	uint32_t intmask_org;
	struct Scsi_Host *host = pci_get_drvdata(pdev);
	struct AdapterControlBlock *acb =
		(struct AdapterControlBlock *)host->hostdata;

	intmask_org = arcmsr_disable_outbound_ints(acb);
	arcmsr_free_irq(pdev, acb);
	del_timer_sync(&acb->eternal_timer);
	flush_work(&acb->arcmsr_do_message_isr_bh);
	arcmsr_stop_adapter_bgrb(acb);
	arcmsr_flush_adapter_cache(acb);
	pci_set_drvdata(pdev, host);
	pci_save_state(pdev);
	pci_disable_device(pdev);
	pci_set_power_state(pdev, pci_choose_state(pdev, state));
	return 0;
}

static int arcmsr_resume(struct pci_dev *pdev)
{
	int error;
	struct Scsi_Host *host = pci_get_drvdata(pdev);
	struct AdapterControlBlock *acb =
		(struct AdapterControlBlock *)host->hostdata;

	pci_set_power_state(pdev, PCI_D0);
	pci_enable_wake(pdev, PCI_D0, 0);
	pci_restore_state(pdev);
	if (pci_enable_device(pdev)) {
		pr_warn("%s: pci_enable_device error\n", __func__);
		return -ENODEV;
	}
	error = pci_set_dma_mask(pdev, DMA_BIT_MASK(64));
	if (error) {
		error = pci_set_dma_mask(pdev, DMA_BIT_MASK(32));
		if (error) {
			pr_warn("scsi%d: No suitable DMA mask available\n",
			       host->host_no);
			goto controller_unregister;
		}
	}
	pci_set_master(pdev);
	if (arcmsr_request_irq(pdev, acb) == FAILED)
		goto controller_stop;
	arcmsr_iop_init(acb);
	INIT_WORK(&acb->arcmsr_do_message_isr_bh, arcmsr_message_isr_bh_fn);
	atomic_set(&acb->rq_map_token, 16);
	atomic_set(&acb->ante_token_value, 16);
	acb->fw_flag = FW_NORMAL;
	init_timer(&acb->eternal_timer);
	acb->eternal_timer.expires = jiffies + msecs_to_jiffies(6 * HZ);
	acb->eternal_timer.data = (unsigned long) acb;
	acb->eternal_timer.function = &arcmsr_request_device_map;
	add_timer(&acb->eternal_timer);
	return 0;
controller_stop:
	arcmsr_stop_adapter_bgrb(acb);
	arcmsr_flush_adapter_cache(acb);
controller_unregister:
	scsi_remove_host(host);
	arcmsr_free_ccb_pool(acb);
	arcmsr_unmap_pciregion(acb);
	pci_release_regions(pdev);
	scsi_host_put(host);
	pci_disable_device(pdev);
	return -ENODEV;
}

803
static uint8_t arcmsr_hbaA_abort_allcmd(struct AdapterControlBlock *acb)
804
{
A
Al Viro 已提交
805
	struct MessageUnit_A __iomem *reg = acb->pmuA;
806
	writel(ARCMSR_INBOUND_MESG0_ABORT_CMD, &reg->inbound_msgaddr0);
807
	if (!arcmsr_hbaA_wait_msgint_ready(acb)) {
808
		printk(KERN_NOTICE
809
			"arcmsr%d: wait 'abort all outstanding command' timeout\n"
810
			, acb->host->host_no);
811
		return false;
812
	}
813
	return true;
814 815
}

816
static uint8_t arcmsr_hbaB_abort_allcmd(struct AdapterControlBlock *acb)
817
{
A
Al Viro 已提交
818
	struct MessageUnit_B *reg = acb->pmuB;
819

820
	writel(ARCMSR_MESSAGE_ABORT_CMD, reg->drv2iop_doorbell);
821
	if (!arcmsr_hbaB_wait_msgint_ready(acb)) {
822
		printk(KERN_NOTICE
823
			"arcmsr%d: wait 'abort all outstanding command' timeout\n"
824
			, acb->host->host_no);
825
		return false;
826
	}
827 828
	return true;
}
829
static uint8_t arcmsr_hbaC_abort_allcmd(struct AdapterControlBlock *pACB)
830 831 832 833
{
	struct MessageUnit_C *reg = (struct MessageUnit_C *)pACB->pmuC;
	writel(ARCMSR_INBOUND_MESG0_ABORT_CMD, &reg->inbound_msgaddr0);
	writel(ARCMSR_HBCMU_DRV2IOP_MESSAGE_CMD_DONE, &reg->inbound_doorbell);
834
	if (!arcmsr_hbaC_wait_msgint_ready(pACB)) {
835
		printk(KERN_NOTICE
836
			"arcmsr%d: wait 'abort all outstanding command' timeout\n"
837 838 839 840
			, pACB->host->host_no);
		return false;
	}
	return true;
841
}
842
static uint8_t arcmsr_abort_allcmd(struct AdapterControlBlock *acb)
843
{
844
	uint8_t rtnval = 0;
845 846
	switch (acb->adapter_type) {
	case ACB_ADAPTER_TYPE_A: {
847
		rtnval = arcmsr_hbaA_abort_allcmd(acb);
848 849 850 851
		}
		break;

	case ACB_ADAPTER_TYPE_B: {
852
		rtnval = arcmsr_hbaB_abort_allcmd(acb);
853
		}
854 855 856
		break;

	case ACB_ADAPTER_TYPE_C: {
857
		rtnval = arcmsr_hbaC_abort_allcmd(acb);
858
		}
859
	}
860
	return rtnval;
861 862
}

863 864 865 866
static void arcmsr_pci_unmap_dma(struct CommandControlBlock *ccb)
{
	struct scsi_cmnd *pcmd = ccb->pcmd;

867
	scsi_dma_unmap(pcmd);
868
}
869

870
static void arcmsr_ccb_complete(struct CommandControlBlock *ccb)
871 872 873
{
	struct AdapterControlBlock *acb = ccb->acb;
	struct scsi_cmnd *pcmd = ccb->pcmd;
874 875
	unsigned long flags;
	atomic_dec(&acb->ccboutstandingcount);
876 877
	arcmsr_pci_unmap_dma(ccb);
	ccb->startdone = ARCMSR_CCB_DONE;
878
	spin_lock_irqsave(&acb->ccblist_lock, flags);
879
	list_add_tail(&ccb->list, &acb->ccb_free_list);
880
	spin_unlock_irqrestore(&acb->ccblist_lock, flags);
881 882 883
	pcmd->scsi_done(pcmd);
}

884 885 886 887 888 889 890 891
static void arcmsr_report_sense_info(struct CommandControlBlock *ccb)
{

	struct scsi_cmnd *pcmd = ccb->pcmd;
	struct SENSE_DATA *sensebuffer = (struct SENSE_DATA *)pcmd->sense_buffer;
	pcmd->result = DID_OK << 16;
	if (sensebuffer) {
		int sense_data_length =
892 893 894
			sizeof(struct SENSE_DATA) < SCSI_SENSE_BUFFERSIZE
			? sizeof(struct SENSE_DATA) : SCSI_SENSE_BUFFERSIZE;
		memset(sensebuffer, 0, SCSI_SENSE_BUFFERSIZE);
895 896 897 898 899 900 901 902 903
		memcpy(sensebuffer, ccb->arcmsr_cdb.SenseData, sense_data_length);
		sensebuffer->ErrorCode = SCSI_SENSE_CURRENT_ERRORS;
		sensebuffer->Valid = 1;
	}
}

static u32 arcmsr_disable_outbound_ints(struct AdapterControlBlock *acb)
{
	u32 orig_mask = 0;
904
	switch (acb->adapter_type) {	
905
	case ACB_ADAPTER_TYPE_A : {
A
Al Viro 已提交
906
		struct MessageUnit_A __iomem *reg = acb->pmuA;
907
		orig_mask = readl(&reg->outbound_intmask);
908 909 910 911 912
		writel(orig_mask|ARCMSR_MU_OUTBOUND_ALL_INTMASKENABLE, \
						&reg->outbound_intmask);
		}
		break;
	case ACB_ADAPTER_TYPE_B : {
A
Al Viro 已提交
913
		struct MessageUnit_B *reg = acb->pmuB;
914 915
		orig_mask = readl(reg->iop2drv_doorbell_mask);
		writel(0, reg->iop2drv_doorbell_mask);
916 917
		}
		break;
918 919 920 921 922 923 924
	case ACB_ADAPTER_TYPE_C:{
		struct MessageUnit_C *reg = (struct MessageUnit_C *)acb->pmuC;
		/* disable all outbound interrupt */
		orig_mask = readl(&reg->host_int_mask); /* disable outbound message0 int */
		writel(orig_mask|ARCMSR_HBCMU_ALL_INTMASKENABLE, &reg->host_int_mask);
		}
		break;
925 926 927 928
	}
	return orig_mask;
}

929 930
static void arcmsr_report_ccb_state(struct AdapterControlBlock *acb, 
			struct CommandControlBlock *ccb, bool error)
931 932 933 934
{
	uint8_t id, lun;
	id = ccb->pcmd->device->id;
	lun = ccb->pcmd->device->lun;
935
	if (!error) {
936 937
		if (acb->devstate[id][lun] == ARECA_RAID_GONE)
			acb->devstate[id][lun] = ARECA_RAID_GOOD;
938 939
		ccb->pcmd->result = DID_OK << 16;
		arcmsr_ccb_complete(ccb);
940
	}else{
941 942 943 944
		switch (ccb->arcmsr_cdb.DeviceStatus) {
		case ARCMSR_DEV_SELECT_TIMEOUT: {
			acb->devstate[id][lun] = ARECA_RAID_GONE;
			ccb->pcmd->result = DID_NO_CONNECT << 16;
945
			arcmsr_ccb_complete(ccb);
946 947 948 949 950 951 952 953
			}
			break;

		case ARCMSR_DEV_ABORTED:

		case ARCMSR_DEV_INIT_FAIL: {
			acb->devstate[id][lun] = ARECA_RAID_GONE;
			ccb->pcmd->result = DID_BAD_TARGET << 16;
954
			arcmsr_ccb_complete(ccb);
955 956 957 958 959 960
			}
			break;

		case ARCMSR_DEV_CHECK_CONDITION: {
			acb->devstate[id][lun] = ARECA_RAID_GOOD;
			arcmsr_report_sense_info(ccb);
961
			arcmsr_ccb_complete(ccb);
962 963 964 965
			}
			break;

		default:
966 967 968 969 970 971 972 973 974 975
			printk(KERN_NOTICE
				"arcmsr%d: scsi id = %d lun = %d isr get command error done, \
				but got unknown DeviceStatus = 0x%x \n"
				, acb->host->host_no
				, id
				, lun
				, ccb->arcmsr_cdb.DeviceStatus);
				acb->devstate[id][lun] = ARECA_RAID_GONE;
				ccb->pcmd->result = DID_NO_CONNECT << 16;
				arcmsr_ccb_complete(ccb);
976 977 978 979 980
			break;
		}
	}
}

981
static void arcmsr_drain_donequeue(struct AdapterControlBlock *acb, struct CommandControlBlock *pCCB, bool error)
982
{
983
	int id, lun;
984 985 986
	if ((pCCB->acb != acb) || (pCCB->startdone != ARCMSR_CCB_START)) {
		if (pCCB->startdone == ARCMSR_CCB_ABORTED) {
			struct scsi_cmnd *abortcmd = pCCB->pcmd;
987
			if (abortcmd) {
988
				id = abortcmd->device->id;
989
				lun = abortcmd->device->lun;				
990
				abortcmd->result |= DID_ABORT << 16;
991 992 993
				arcmsr_ccb_complete(pCCB);
				printk(KERN_NOTICE "arcmsr%d: pCCB ='0x%p' isr got aborted command \n",
				acb->host->host_no, pCCB);
994
			}
995
			return;
996 997 998 999 1000 1001 1002
		}
		printk(KERN_NOTICE "arcmsr%d: isr get an illegal ccb command \
				done acb = '0x%p'"
				"ccb = '0x%p' ccbacb = '0x%p' startdone = 0x%x"
				" ccboutstandingcount = %d \n"
				, acb->host->host_no
				, acb
1003 1004 1005
				, pCCB
				, pCCB->acb
				, pCCB->startdone
1006
				, atomic_read(&acb->ccboutstandingcount));
1007
		  return;
1008
	}
1009
	arcmsr_report_ccb_state(acb, pCCB, error);
1010 1011 1012 1013 1014 1015
}

static void arcmsr_done4abort_postqueue(struct AdapterControlBlock *acb)
{
	int i = 0;
	uint32_t flag_ccb;
1016 1017 1018
	struct ARCMSR_CDB *pARCMSR_CDB;
	bool error;
	struct CommandControlBlock *pCCB;
1019 1020 1021
	switch (acb->adapter_type) {

	case ACB_ADAPTER_TYPE_A: {
A
Al Viro 已提交
1022
		struct MessageUnit_A __iomem *reg = acb->pmuA;
1023
		uint32_t outbound_intstatus;
A
Al Viro 已提交
1024
		outbound_intstatus = readl(&reg->outbound_intstatus) &
1025 1026 1027
					acb->outbound_int_enable;
		/*clear and abort all outbound posted Q*/
		writel(outbound_intstatus, &reg->outbound_intstatus);/*clear interrupt*/
1028
		while(((flag_ccb = readl(&reg->outbound_queueport)) != 0xFFFFFFFF)
1029
				&& (i++ < ARCMSR_MAX_OUTSTANDING_CMD)) {
1030 1031 1032 1033
			pARCMSR_CDB = (struct ARCMSR_CDB *)(acb->vir2phy_offset + (flag_ccb << 5));/*frame must be 32 bytes aligned*/
			pCCB = container_of(pARCMSR_CDB, struct CommandControlBlock, arcmsr_cdb);
			error = (flag_ccb & ARCMSR_CCBREPLY_FLAG_ERROR_MODE0) ? true : false;
			arcmsr_drain_donequeue(acb, pCCB, error);
1034 1035 1036 1037 1038
		}
		}
		break;

	case ACB_ADAPTER_TYPE_B: {
A
Al Viro 已提交
1039
		struct MessageUnit_B *reg = acb->pmuB;
1040
		/*clear all outbound posted Q*/
1041
		writel(ARCMSR_DOORBELL_INT_CLEAR_PATTERN, reg->iop2drv_doorbell); /* clear doorbell interrupt */
1042 1043 1044
		for (i = 0; i < ARCMSR_MAX_HBB_POSTQUEUE; i++) {
			if ((flag_ccb = readl(&reg->done_qbuffer[i])) != 0) {
				writel(0, &reg->done_qbuffer[i]);
1045 1046 1047 1048
				pARCMSR_CDB = (struct ARCMSR_CDB *)(acb->vir2phy_offset+(flag_ccb << 5));/*frame must be 32 bytes aligned*/
				pCCB = container_of(pARCMSR_CDB, struct CommandControlBlock, arcmsr_cdb);
				error = (flag_ccb & ARCMSR_CCBREPLY_FLAG_ERROR_MODE0) ? true : false;
				arcmsr_drain_donequeue(acb, pCCB, error);
1049
			}
1050
			reg->post_qbuffer[i] = 0;
1051 1052 1053 1054 1055
		}
		reg->doneq_index = 0;
		reg->postq_index = 0;
		}
		break;
1056 1057 1058 1059 1060 1061 1062 1063 1064 1065 1066 1067 1068 1069 1070 1071
	case ACB_ADAPTER_TYPE_C: {
		struct MessageUnit_C *reg = acb->pmuC;
		struct  ARCMSR_CDB *pARCMSR_CDB;
		uint32_t flag_ccb, ccb_cdb_phy;
		bool error;
		struct CommandControlBlock *pCCB;
		while ((readl(&reg->host_int_status) & ARCMSR_HBCMU_OUTBOUND_POSTQUEUE_ISR) && (i++ < ARCMSR_MAX_OUTSTANDING_CMD)) {
			/*need to do*/
			flag_ccb = readl(&reg->outbound_queueport_low);
			ccb_cdb_phy = (flag_ccb & 0xFFFFFFF0);
			pARCMSR_CDB = (struct  ARCMSR_CDB *)(acb->vir2phy_offset+ccb_cdb_phy);/*frame must be 32 bytes aligned*/
			pCCB = container_of(pARCMSR_CDB, struct CommandControlBlock, arcmsr_cdb);
			error = (flag_ccb & ARCMSR_CCBREPLY_FLAG_ERROR_MODE1) ? true : false;
			arcmsr_drain_donequeue(acb, pCCB, error);
		}
	}
1072 1073
	}
}
1074

1075 1076 1077 1078 1079 1080 1081 1082
static void arcmsr_remove(struct pci_dev *pdev)
{
	struct Scsi_Host *host = pci_get_drvdata(pdev);
	struct AdapterControlBlock *acb =
		(struct AdapterControlBlock *) host->hostdata;
	int poll_count = 0;
	arcmsr_free_sysfs_attr(acb);
	scsi_remove_host(host);
1083
	flush_work(&acb->arcmsr_do_message_isr_bh);
1084 1085
	del_timer_sync(&acb->eternal_timer);
	arcmsr_disable_outbound_ints(acb);
1086
	arcmsr_stop_adapter_bgrb(acb);
1087
	arcmsr_flush_adapter_cache(acb);	
1088 1089 1090
	acb->acb_flags |= ACB_F_SCSISTOPADAPTER;
	acb->acb_flags &= ~ACB_F_IOP_INITED;

1091
	for (poll_count = 0; poll_count < ARCMSR_MAX_OUTSTANDING_CMD; poll_count++){
1092 1093
		if (!atomic_read(&acb->ccboutstandingcount))
			break;
1094
		arcmsr_interrupt(acb);/* FIXME: need spinlock */
1095 1096 1097 1098 1099 1100 1101
		msleep(25);
	}

	if (atomic_read(&acb->ccboutstandingcount)) {
		int i;

		arcmsr_abort_allcmd(acb);
1102
		arcmsr_done4abort_postqueue(acb);
1103 1104 1105 1106 1107
		for (i = 0; i < ARCMSR_MAX_FREECCB_NUM; i++) {
			struct CommandControlBlock *ccb = acb->pccb_pool[i];
			if (ccb->startdone == ARCMSR_CCB_START) {
				ccb->startdone = ARCMSR_CCB_ABORTED;
				ccb->pcmd->result = DID_ABORT << 16;
1108
				arcmsr_ccb_complete(ccb);
1109 1110 1111
			}
		}
	}
1112
	arcmsr_free_irq(pdev, acb);
1113
	arcmsr_free_ccb_pool(acb);
1114
	arcmsr_free_mu(acb);
1115
	arcmsr_unmap_pciregion(acb);
1116
	pci_release_regions(pdev);
1117
	scsi_host_put(host);
1118 1119 1120 1121 1122 1123 1124 1125
	pci_disable_device(pdev);
}

static void arcmsr_shutdown(struct pci_dev *pdev)
{
	struct Scsi_Host *host = pci_get_drvdata(pdev);
	struct AdapterControlBlock *acb =
		(struct AdapterControlBlock *)host->hostdata;
1126 1127
	del_timer_sync(&acb->eternal_timer);
	arcmsr_disable_outbound_ints(acb);
1128
	arcmsr_free_irq(pdev, acb);
1129
	flush_work(&acb->arcmsr_do_message_isr_bh);
1130 1131 1132 1133 1134 1135 1136 1137 1138 1139 1140 1141 1142 1143 1144 1145 1146 1147
	arcmsr_stop_adapter_bgrb(acb);
	arcmsr_flush_adapter_cache(acb);
}

static int arcmsr_module_init(void)
{
	int error = 0;
	error = pci_register_driver(&arcmsr_pci_driver);
	return error;
}

static void arcmsr_module_exit(void)
{
	pci_unregister_driver(&arcmsr_pci_driver);
}
module_init(arcmsr_module_init);
module_exit(arcmsr_module_exit);

1148
static void arcmsr_enable_outbound_ints(struct AdapterControlBlock *acb,
1149
						u32 intmask_org)
1150 1151
{
	u32 mask;
1152
	switch (acb->adapter_type) {
1153

1154
	case ACB_ADAPTER_TYPE_A: {
A
Al Viro 已提交
1155
		struct MessageUnit_A __iomem *reg = acb->pmuA;
1156
		mask = intmask_org & ~(ARCMSR_MU_OUTBOUND_POSTQUEUE_INTMASKENABLE |
1157 1158
			     ARCMSR_MU_OUTBOUND_DOORBELL_INTMASKENABLE|
			     ARCMSR_MU_OUTBOUND_MESSAGE0_INTMASKENABLE);
1159 1160 1161 1162
		writel(mask, &reg->outbound_intmask);
		acb->outbound_int_enable = ~(intmask_org & mask) & 0x000000ff;
		}
		break;
1163

1164
	case ACB_ADAPTER_TYPE_B: {
A
Al Viro 已提交
1165
		struct MessageUnit_B *reg = acb->pmuB;
1166 1167 1168 1169
		mask = intmask_org | (ARCMSR_IOP2DRV_DATA_WRITE_OK |
			ARCMSR_IOP2DRV_DATA_READ_OK |
			ARCMSR_IOP2DRV_CDB_DONE |
			ARCMSR_IOP2DRV_MESSAGE_CMD_DONE);
1170
		writel(mask, reg->iop2drv_doorbell_mask);
1171 1172
		acb->outbound_int_enable = (intmask_org | mask) & 0x0000000f;
		}
1173 1174 1175 1176 1177 1178 1179
		break;
	case ACB_ADAPTER_TYPE_C: {
		struct MessageUnit_C *reg = acb->pmuC;
		mask = ~(ARCMSR_HBCMU_UTILITY_A_ISR_MASK | ARCMSR_HBCMU_OUTBOUND_DOORBELL_ISR_MASK|ARCMSR_HBCMU_OUTBOUND_POSTQUEUE_ISR_MASK);
		writel(intmask_org & mask, &reg->host_int_mask);
		acb->outbound_int_enable = ~(intmask_org & mask) & 0x0000000f;
		}
1180 1181 1182
	}
}

N
Nick Cheng 已提交
1183
static int arcmsr_build_ccb(struct AdapterControlBlock *acb,
1184
	struct CommandControlBlock *ccb, struct scsi_cmnd *pcmd)
1185
{
1186 1187
	struct ARCMSR_CDB *arcmsr_cdb = (struct ARCMSR_CDB *)&ccb->arcmsr_cdb;
	int8_t *psge = (int8_t *)&arcmsr_cdb->u;
A
Al Viro 已提交
1188
	__le32 address_lo, address_hi;
1189
	int arccdbsize = 0x30;
1190
	__le32 length = 0;
1191
	int i;
1192
	struct scatterlist *sg;
1193
	int nseg;
1194
	ccb->pcmd = pcmd;
1195
	memset(arcmsr_cdb, 0, sizeof(struct ARCMSR_CDB));
1196 1197 1198
	arcmsr_cdb->TargetID = pcmd->device->id;
	arcmsr_cdb->LUN = pcmd->device->lun;
	arcmsr_cdb->Function = 1;
1199
	arcmsr_cdb->msgContext = 0;
1200
	memcpy(arcmsr_cdb->Cdb, pcmd->cmnd, pcmd->cmd_len);
1201 1202

	nseg = scsi_dma_map(pcmd);
1203
	if (unlikely(nseg > acb->host->sg_tablesize || nseg < 0))
N
Nick Cheng 已提交
1204
		return FAILED;
1205 1206 1207 1208 1209 1210 1211 1212 1213 1214 1215 1216 1217 1218
	scsi_for_each_sg(pcmd, sg, nseg, i) {
		/* Get the physical address of the current data pointer */
		length = cpu_to_le32(sg_dma_len(sg));
		address_lo = cpu_to_le32(dma_addr_lo32(sg_dma_address(sg)));
		address_hi = cpu_to_le32(dma_addr_hi32(sg_dma_address(sg)));
		if (address_hi == 0) {
			struct SG32ENTRY *pdma_sg = (struct SG32ENTRY *)psge;

			pdma_sg->address = address_lo;
			pdma_sg->length = length;
			psge += sizeof (struct SG32ENTRY);
			arccdbsize += sizeof (struct SG32ENTRY);
		} else {
			struct SG64ENTRY *pdma_sg = (struct SG64ENTRY *)psge;
1219

1220 1221 1222 1223 1224
			pdma_sg->addresshigh = address_hi;
			pdma_sg->address = address_lo;
			pdma_sg->length = length|cpu_to_le32(IS_SG64_ADDR);
			psge += sizeof (struct SG64ENTRY);
			arccdbsize += sizeof (struct SG64ENTRY);
1225
		}
1226 1227 1228
	}
	arcmsr_cdb->sgcount = (uint8_t)nseg;
	arcmsr_cdb->DataLength = scsi_bufflen(pcmd);
1229
	arcmsr_cdb->msgPages = arccdbsize/0x100 + (arccdbsize % 0x100 ? 1 : 0);
1230 1231
	if ( arccdbsize > 256)
		arcmsr_cdb->Flags |= ARCMSR_CDB_FLAG_SGL_BSIZE;
1232
	if (pcmd->sc_data_direction == DMA_TO_DEVICE)
1233
		arcmsr_cdb->Flags |= ARCMSR_CDB_FLAG_WRITE;
1234
	ccb->arc_cdb_size = arccdbsize;
N
Nick Cheng 已提交
1235
	return SUCCESS;
1236 1237 1238 1239
}

static void arcmsr_post_ccb(struct AdapterControlBlock *acb, struct CommandControlBlock *ccb)
{
1240
	uint32_t cdb_phyaddr = ccb->cdb_phyaddr;
1241 1242 1243
	struct ARCMSR_CDB *arcmsr_cdb = (struct ARCMSR_CDB *)&ccb->arcmsr_cdb;
	atomic_inc(&acb->ccboutstandingcount);
	ccb->startdone = ARCMSR_CCB_START;
1244 1245
	switch (acb->adapter_type) {
	case ACB_ADAPTER_TYPE_A: {
A
Al Viro 已提交
1246
		struct MessageUnit_A __iomem *reg = acb->pmuA;
1247 1248

		if (arcmsr_cdb->Flags & ARCMSR_CDB_FLAG_SGL_BSIZE)
1249
			writel(cdb_phyaddr | ARCMSR_CCBPOST_FLAG_SGL_BSIZE,
1250
			&reg->inbound_queueport);
1251 1252
		else
			writel(cdb_phyaddr, &reg->inbound_queueport);
1253
		break;
1254
	}
1255

1256
	case ACB_ADAPTER_TYPE_B: {
A
Al Viro 已提交
1257
		struct MessageUnit_B *reg = acb->pmuB;
1258
		uint32_t ending_index, index = reg->postq_index;
1259

1260 1261 1262
		ending_index = ((index + 1) % ARCMSR_MAX_HBB_POSTQUEUE);
		writel(0, &reg->post_qbuffer[ending_index]);
		if (arcmsr_cdb->Flags & ARCMSR_CDB_FLAG_SGL_BSIZE) {
1263
			writel(cdb_phyaddr | ARCMSR_CCBPOST_FLAG_SGL_BSIZE,
1264
						 &reg->post_qbuffer[index]);
1265
		} else {
1266
			writel(cdb_phyaddr, &reg->post_qbuffer[index]);
1267 1268 1269 1270
		}
		index++;
		index %= ARCMSR_MAX_HBB_POSTQUEUE;/*if last index number set it to 0 */
		reg->postq_index = index;
1271
		writel(ARCMSR_DRV2IOP_CDB_POSTED, reg->drv2iop_doorbell);
1272
		}
1273
		break;
1274 1275 1276 1277 1278
	case ACB_ADAPTER_TYPE_C: {
		struct MessageUnit_C *phbcmu = (struct MessageUnit_C *)acb->pmuC;
		uint32_t ccb_post_stamp, arc_cdb_size;

		arc_cdb_size = (ccb->arc_cdb_size > 0x300) ? 0x300 : ccb->arc_cdb_size;
1279
		ccb_post_stamp = (cdb_phyaddr | ((arc_cdb_size - 1) >> 6) | 1);
1280 1281 1282 1283 1284 1285 1286
		if (acb->cdb_phyaddr_hi32) {
			writel(acb->cdb_phyaddr_hi32, &phbcmu->inbound_queueport_high);
			writel(ccb_post_stamp, &phbcmu->inbound_queueport_low);
		} else {
			writel(ccb_post_stamp, &phbcmu->inbound_queueport_low);
		}
		}
1287 1288 1289
	}
}

1290
static void arcmsr_hbaA_stop_bgrb(struct AdapterControlBlock *acb)
1291
{
A
Al Viro 已提交
1292
	struct MessageUnit_A __iomem *reg = acb->pmuA;
1293 1294
	acb->acb_flags &= ~ACB_F_MSG_START_BGRB;
	writel(ARCMSR_INBOUND_MESG0_STOP_BGRB, &reg->inbound_msgaddr0);
1295
	if (!arcmsr_hbaA_wait_msgint_ready(acb)) {
1296
		printk(KERN_NOTICE
1297
			"arcmsr%d: wait 'stop adapter background rebulid' timeout\n"
1298 1299 1300 1301
			, acb->host->host_no);
	}
}

1302
static void arcmsr_hbaB_stop_bgrb(struct AdapterControlBlock *acb)
1303
{
A
Al Viro 已提交
1304
	struct MessageUnit_B *reg = acb->pmuB;
1305
	acb->acb_flags &= ~ACB_F_MSG_START_BGRB;
1306
	writel(ARCMSR_MESSAGE_STOP_BGRB, reg->drv2iop_doorbell);
1307

1308
	if (!arcmsr_hbaB_wait_msgint_ready(acb)) {
1309
		printk(KERN_NOTICE
1310
			"arcmsr%d: wait 'stop adapter background rebulid' timeout\n"
1311
			, acb->host->host_no);
1312 1313 1314
	}
}

1315
static void arcmsr_hbaC_stop_bgrb(struct AdapterControlBlock *pACB)
1316 1317 1318 1319 1320
{
	struct MessageUnit_C *reg = (struct MessageUnit_C *)pACB->pmuC;
	pACB->acb_flags &= ~ACB_F_MSG_START_BGRB;
	writel(ARCMSR_INBOUND_MESG0_STOP_BGRB, &reg->inbound_msgaddr0);
	writel(ARCMSR_HBCMU_DRV2IOP_MESSAGE_CMD_DONE, &reg->inbound_doorbell);
1321
	if (!arcmsr_hbaC_wait_msgint_ready(pACB)) {
1322
		printk(KERN_NOTICE
1323
			"arcmsr%d: wait 'stop adapter background rebulid' timeout\n"
1324 1325 1326 1327
			, pACB->host->host_no);
	}
	return;
}
1328 1329 1330 1331
static void arcmsr_stop_adapter_bgrb(struct AdapterControlBlock *acb)
{
	switch (acb->adapter_type) {
	case ACB_ADAPTER_TYPE_A: {
1332
		arcmsr_hbaA_stop_bgrb(acb);
1333 1334 1335 1336
		}
		break;

	case ACB_ADAPTER_TYPE_B: {
1337
		arcmsr_hbaB_stop_bgrb(acb);
1338 1339
		}
		break;
1340
	case ACB_ADAPTER_TYPE_C: {
1341
		arcmsr_hbaC_stop_bgrb(acb);
1342
		}
1343
	}
1344 1345 1346 1347
}

static void arcmsr_free_ccb_pool(struct AdapterControlBlock *acb)
{
1348
	dma_free_coherent(&acb->pdev->dev, acb->uncache_size, acb->dma_coherent, acb->dma_coherent_handle);
1349 1350
}

1351
void arcmsr_iop_message_read(struct AdapterControlBlock *acb)
1352
{
1353 1354
	switch (acb->adapter_type) {
	case ACB_ADAPTER_TYPE_A: {
A
Al Viro 已提交
1355
		struct MessageUnit_A __iomem *reg = acb->pmuA;
1356 1357 1358
		writel(ARCMSR_INBOUND_DRIVER_DATA_READ_OK, &reg->inbound_doorbell);
		}
		break;
1359

1360
	case ACB_ADAPTER_TYPE_B: {
A
Al Viro 已提交
1361
		struct MessageUnit_B *reg = acb->pmuB;
1362
		writel(ARCMSR_DRV2IOP_DATA_READ_OK, reg->drv2iop_doorbell);
1363
		}
1364
		break;
1365 1366 1367 1368
	case ACB_ADAPTER_TYPE_C: {
		struct MessageUnit_C __iomem *reg = acb->pmuC;
		writel(ARCMSR_HBCMU_DRV2IOP_DATA_READ_OK, &reg->inbound_doorbell);
		}
1369
	}
1370 1371 1372 1373 1374 1375
}

static void arcmsr_iop_message_wrote(struct AdapterControlBlock *acb)
{
	switch (acb->adapter_type) {
	case ACB_ADAPTER_TYPE_A: {
A
Al Viro 已提交
1376
		struct MessageUnit_A __iomem *reg = acb->pmuA;
1377
		/*
1378 1379
		** push inbound doorbell tell iop, driver data write ok
		** and wait reply on next hwinterrupt for next Qbuffer post
1380
		*/
1381 1382 1383 1384 1385
		writel(ARCMSR_INBOUND_DRIVER_DATA_WRITE_OK, &reg->inbound_doorbell);
		}
		break;

	case ACB_ADAPTER_TYPE_B: {
A
Al Viro 已提交
1386
		struct MessageUnit_B *reg = acb->pmuB;
1387 1388 1389 1390
		/*
		** push inbound doorbell tell iop, driver data write ok
		** and wait reply on next hwinterrupt for next Qbuffer post
		*/
1391
		writel(ARCMSR_DRV2IOP_DATA_WRITE_OK, reg->drv2iop_doorbell);
1392 1393
		}
		break;
1394 1395 1396 1397 1398 1399 1400 1401 1402
	case ACB_ADAPTER_TYPE_C: {
		struct MessageUnit_C __iomem *reg = acb->pmuC;
		/*
		** push inbound doorbell tell iop, driver data write ok
		** and wait reply on next hwinterrupt for next Qbuffer post
		*/
		writel(ARCMSR_HBCMU_DRV2IOP_DATA_WRITE_OK, &reg->inbound_doorbell);
		}
		break;
1403 1404 1405
	}
}

A
Al Viro 已提交
1406
struct QBUFFER __iomem *arcmsr_get_iop_rqbuffer(struct AdapterControlBlock *acb)
1407
{
1408
	struct QBUFFER __iomem *qbuffer = NULL;
1409 1410 1411
	switch (acb->adapter_type) {

	case ACB_ADAPTER_TYPE_A: {
A
Al Viro 已提交
1412 1413
		struct MessageUnit_A __iomem *reg = acb->pmuA;
		qbuffer = (struct QBUFFER __iomem *)&reg->message_rbuffer;
1414 1415 1416 1417
		}
		break;

	case ACB_ADAPTER_TYPE_B: {
A
Al Viro 已提交
1418
		struct MessageUnit_B *reg = acb->pmuB;
1419
		qbuffer = (struct QBUFFER __iomem *)reg->message_rbuffer;
1420 1421
		}
		break;
1422 1423 1424 1425
	case ACB_ADAPTER_TYPE_C: {
		struct MessageUnit_C *phbcmu = (struct MessageUnit_C *)acb->pmuC;
		qbuffer = (struct QBUFFER __iomem *)&phbcmu->message_rbuffer;
		}
1426 1427 1428 1429
	}
	return qbuffer;
}

A
Al Viro 已提交
1430
static struct QBUFFER __iomem *arcmsr_get_iop_wqbuffer(struct AdapterControlBlock *acb)
1431
{
1432
	struct QBUFFER __iomem *pqbuffer = NULL;
1433 1434 1435
	switch (acb->adapter_type) {

	case ACB_ADAPTER_TYPE_A: {
A
Al Viro 已提交
1436 1437
		struct MessageUnit_A __iomem *reg = acb->pmuA;
		pqbuffer = (struct QBUFFER __iomem *) &reg->message_wbuffer;
1438 1439 1440 1441
		}
		break;

	case ACB_ADAPTER_TYPE_B: {
A
Al Viro 已提交
1442
		struct MessageUnit_B  *reg = acb->pmuB;
1443
		pqbuffer = (struct QBUFFER __iomem *)reg->message_wbuffer;
1444 1445
		}
		break;
1446 1447 1448 1449 1450
	case ACB_ADAPTER_TYPE_C: {
		struct MessageUnit_C *reg = (struct MessageUnit_C *)acb->pmuC;
		pqbuffer = (struct QBUFFER __iomem *)&reg->message_wbuffer;
	}

1451 1452 1453 1454 1455 1456
	}
	return pqbuffer;
}

static void arcmsr_iop2drv_data_wrote_handle(struct AdapterControlBlock *acb)
{
A
Al Viro 已提交
1457
	struct QBUFFER __iomem *prbuffer;
1458
	struct QBUFFER *pQbuffer;
A
Al Viro 已提交
1459
	uint8_t __iomem *iop_data;
1460 1461 1462 1463
	int32_t my_empty_len, iop_len, rqbuf_firstindex, rqbuf_lastindex;
	rqbuf_lastindex = acb->rqbuf_lastindex;
	rqbuf_firstindex = acb->rqbuf_firstindex;
	prbuffer = arcmsr_get_iop_rqbuffer(acb);
A
Al Viro 已提交
1464
	iop_data = (uint8_t __iomem *)prbuffer->data;
1465
	iop_len = prbuffer->data_len;
1466
	my_empty_len = (rqbuf_firstindex - rqbuf_lastindex - 1) & (ARCMSR_MAX_QBUFFER - 1);
1467 1468 1469 1470 1471

	if (my_empty_len >= iop_len)
	{
		while (iop_len > 0) {
			pQbuffer = (struct QBUFFER *)&acb->rqbuffer[rqbuf_lastindex];
1472
			memcpy(pQbuffer, iop_data, 1);
1473 1474 1475 1476 1477 1478 1479 1480 1481 1482 1483 1484 1485 1486 1487 1488 1489 1490 1491
			rqbuf_lastindex++;
			rqbuf_lastindex %= ARCMSR_MAX_QBUFFER;
			iop_data++;
			iop_len--;
		}
		acb->rqbuf_lastindex = rqbuf_lastindex;
		arcmsr_iop_message_read(acb);
	}

	else {
		acb->acb_flags |= ACB_F_IOPDATA_OVERFLOW;
	}
}

static void arcmsr_iop2drv_data_read_handle(struct AdapterControlBlock *acb)
{
	acb->acb_flags |= ACB_F_MESSAGE_WQBUFFER_READED;
	if (acb->wqbuf_firstindex != acb->wqbuf_lastindex) {
		uint8_t *pQbuffer;
A
Al Viro 已提交
1492 1493
		struct QBUFFER __iomem *pwbuffer;
		uint8_t __iomem *iop_data;
1494 1495 1496 1497 1498 1499 1500 1501 1502 1503 1504 1505 1506 1507 1508 1509 1510 1511 1512 1513 1514 1515 1516 1517 1518
		int32_t allxfer_len = 0;

		acb->acb_flags &= (~ACB_F_MESSAGE_WQBUFFER_READED);
		pwbuffer = arcmsr_get_iop_wqbuffer(acb);
		iop_data = (uint8_t __iomem *)pwbuffer->data;

		while ((acb->wqbuf_firstindex != acb->wqbuf_lastindex) && \
							(allxfer_len < 124)) {
			pQbuffer = &acb->wqbuffer[acb->wqbuf_firstindex];
			memcpy(iop_data, pQbuffer, 1);
			acb->wqbuf_firstindex++;
			acb->wqbuf_firstindex %= ARCMSR_MAX_QBUFFER;
			iop_data++;
			allxfer_len++;
		}
		pwbuffer->data_len = allxfer_len;

		arcmsr_iop_message_wrote(acb);
	}

	if (acb->wqbuf_firstindex == acb->wqbuf_lastindex) {
		acb->acb_flags |= ACB_F_MESSAGE_WQBUFFER_CLEARED;
	}
}

1519
static void arcmsr_hbaA_doorbell_isr(struct AdapterControlBlock *acb)
1520 1521
{
	uint32_t outbound_doorbell;
A
Al Viro 已提交
1522
	struct MessageUnit_A __iomem *reg = acb->pmuA;
1523
	outbound_doorbell = readl(&reg->outbound_doorbell);
1524 1525 1526 1527 1528 1529 1530 1531 1532
	do {
		writel(outbound_doorbell, &reg->outbound_doorbell);
		if (outbound_doorbell & ARCMSR_OUTBOUND_IOP331_DATA_WRITE_OK)
			arcmsr_iop2drv_data_wrote_handle(acb);
		if (outbound_doorbell & ARCMSR_OUTBOUND_IOP331_DATA_READ_OK)
			arcmsr_iop2drv_data_read_handle(acb);
		outbound_doorbell = readl(&reg->outbound_doorbell);
	} while (outbound_doorbell & (ARCMSR_OUTBOUND_IOP331_DATA_WRITE_OK
		| ARCMSR_OUTBOUND_IOP331_DATA_READ_OK));
1533
}
1534
static void arcmsr_hbaC_doorbell_isr(struct AdapterControlBlock *pACB)
1535 1536 1537 1538 1539 1540 1541 1542 1543 1544 1545
{
	uint32_t outbound_doorbell;
	struct MessageUnit_C *reg = (struct MessageUnit_C *)pACB->pmuC;
	/*
	*******************************************************************
	**  Maybe here we need to check wrqbuffer_lock is lock or not
	**  DOORBELL: din! don!
	**  check if there are any mail need to pack from firmware
	*******************************************************************
	*/
	outbound_doorbell = readl(&reg->outbound_doorbell);
1546 1547 1548 1549 1550 1551 1552 1553
	do {
		writel(outbound_doorbell, &reg->outbound_doorbell_clear);
		readl(&reg->outbound_doorbell_clear);
		if (outbound_doorbell & ARCMSR_HBCMU_IOP2DRV_DATA_WRITE_OK)
			arcmsr_iop2drv_data_wrote_handle(pACB);
		if (outbound_doorbell & ARCMSR_HBCMU_IOP2DRV_DATA_READ_OK)
			arcmsr_iop2drv_data_read_handle(pACB);
		if (outbound_doorbell & ARCMSR_HBCMU_IOP2DRV_MESSAGE_CMD_DONE)
1554
			arcmsr_hbaC_message_isr(pACB);
1555 1556 1557 1558
		outbound_doorbell = readl(&reg->outbound_doorbell);
	} while (outbound_doorbell & (ARCMSR_HBCMU_IOP2DRV_DATA_WRITE_OK
		| ARCMSR_HBCMU_IOP2DRV_DATA_READ_OK
		| ARCMSR_HBCMU_IOP2DRV_MESSAGE_CMD_DONE));
1559
}
1560
static void arcmsr_hbaA_postqueue_isr(struct AdapterControlBlock *acb)
1561 1562
{
	uint32_t flag_ccb;
A
Al Viro 已提交
1563
	struct MessageUnit_A __iomem *reg = acb->pmuA;
1564 1565 1566
	struct ARCMSR_CDB *pARCMSR_CDB;
	struct CommandControlBlock *pCCB;
	bool error;
1567
	while ((flag_ccb = readl(&reg->outbound_queueport)) != 0xFFFFFFFF) {
1568 1569 1570 1571
		pARCMSR_CDB = (struct ARCMSR_CDB *)(acb->vir2phy_offset + (flag_ccb << 5));/*frame must be 32 bytes aligned*/
		pCCB = container_of(pARCMSR_CDB, struct CommandControlBlock, arcmsr_cdb);
		error = (flag_ccb & ARCMSR_CCBREPLY_FLAG_ERROR_MODE0) ? true : false;
		arcmsr_drain_donequeue(acb, pCCB, error);
1572 1573
	}
}
1574
static void arcmsr_hbaB_postqueue_isr(struct AdapterControlBlock *acb)
1575 1576 1577
{
	uint32_t index;
	uint32_t flag_ccb;
A
Al Viro 已提交
1578
	struct MessageUnit_B *reg = acb->pmuB;
1579 1580 1581
	struct ARCMSR_CDB *pARCMSR_CDB;
	struct CommandControlBlock *pCCB;
	bool error;
1582 1583 1584
	index = reg->doneq_index;
	while ((flag_ccb = readl(&reg->done_qbuffer[index])) != 0) {
		writel(0, &reg->done_qbuffer[index]);
1585 1586 1587 1588
		pARCMSR_CDB = (struct ARCMSR_CDB *)(acb->vir2phy_offset+(flag_ccb << 5));/*frame must be 32 bytes aligned*/
		pCCB = container_of(pARCMSR_CDB, struct CommandControlBlock, arcmsr_cdb);
		error = (flag_ccb & ARCMSR_CCBREPLY_FLAG_ERROR_MODE0) ? true : false;
		arcmsr_drain_donequeue(acb, pCCB, error);
1589 1590 1591 1592 1593
		index++;
		index %= ARCMSR_MAX_HBB_POSTQUEUE;
		reg->doneq_index = index;
	}
}
1594

1595
static void arcmsr_hbaC_postqueue_isr(struct AdapterControlBlock *acb)
1596 1597 1598 1599 1600 1601 1602 1603 1604 1605 1606
{
	struct MessageUnit_C *phbcmu;
	struct ARCMSR_CDB *arcmsr_cdb;
	struct CommandControlBlock *ccb;
	uint32_t flag_ccb, ccb_cdb_phy, throttling = 0;
	int error;

	phbcmu = (struct MessageUnit_C *)acb->pmuC;
	/* areca cdb command done */
	/* Use correct offset and size for syncing */

1607 1608 1609 1610 1611 1612 1613 1614 1615 1616 1617 1618 1619 1620 1621 1622 1623
	while ((flag_ccb = readl(&phbcmu->outbound_queueport_low)) !=
			0xFFFFFFFF) {
		ccb_cdb_phy = (flag_ccb & 0xFFFFFFF0);
		arcmsr_cdb = (struct ARCMSR_CDB *)(acb->vir2phy_offset
			+ ccb_cdb_phy);
		ccb = container_of(arcmsr_cdb, struct CommandControlBlock,
			arcmsr_cdb);
		error = (flag_ccb & ARCMSR_CCBREPLY_FLAG_ERROR_MODE1)
			? true : false;
		/* check if command done with no error */
		arcmsr_drain_donequeue(acb, ccb, error);
		throttling++;
		if (throttling == ARCMSR_HBC_ISR_THROTTLING_LEVEL) {
			writel(ARCMSR_HBCMU_DRV2IOP_POSTQUEUE_THROTTLING,
				&phbcmu->inbound_doorbell);
			throttling = 0;
		}
1624 1625
	}
}
1626 1627 1628 1629
/*
**********************************************************************************
** Handle a message interrupt
**
1630
** The only message interrupt we expect is in response to a query for the current adapter config.  
1631 1632 1633
** We want this in order to compare the drivemap so that we can detect newly-attached drives.
**********************************************************************************
*/
1634
static void arcmsr_hbaA_message_isr(struct AdapterControlBlock *acb)
1635 1636 1637 1638 1639 1640
{
	struct MessageUnit_A *reg  = acb->pmuA;
	/*clear interrupt and message state*/
	writel(ARCMSR_MU_OUTBOUND_MESSAGE0_INT, &reg->outbound_intstatus);
	schedule_work(&acb->arcmsr_do_message_isr_bh);
}
1641
static void arcmsr_hbaB_message_isr(struct AdapterControlBlock *acb)
1642 1643
{
	struct MessageUnit_B *reg  = acb->pmuB;
1644

1645
	/*clear interrupt and message state*/
1646
	writel(ARCMSR_MESSAGE_INT_CLEAR_PATTERN, reg->iop2drv_doorbell);
1647 1648
	schedule_work(&acb->arcmsr_do_message_isr_bh);
}
1649 1650 1651 1652 1653 1654 1655 1656 1657
/*
**********************************************************************************
** Handle a message interrupt
**
** The only message interrupt we expect is in response to a query for the
** current adapter config.
** We want this in order to compare the drivemap so that we can detect newly-attached drives.
**********************************************************************************
*/
1658
static void arcmsr_hbaC_message_isr(struct AdapterControlBlock *acb)
1659 1660 1661 1662 1663 1664 1665
{
	struct MessageUnit_C *reg  = acb->pmuC;
	/*clear interrupt and message state*/
	writel(ARCMSR_HBCMU_IOP2DRV_MESSAGE_CMD_DONE_DOORBELL_CLEAR, &reg->outbound_doorbell_clear);
	schedule_work(&acb->arcmsr_do_message_isr_bh);
}

1666
static int arcmsr_hbaA_handle_isr(struct AdapterControlBlock *acb)
1667 1668
{
	uint32_t outbound_intstatus;
A
Al Viro 已提交
1669
	struct MessageUnit_A __iomem *reg = acb->pmuA;
1670
	outbound_intstatus = readl(&reg->outbound_intstatus) &
1671
		acb->outbound_int_enable;
1672 1673 1674 1675 1676
	if (!(outbound_intstatus & ARCMSR_MU_OUTBOUND_HANDLE_INT))
		return IRQ_NONE;
	do {
		writel(outbound_intstatus, &reg->outbound_intstatus);
		if (outbound_intstatus & ARCMSR_MU_OUTBOUND_DOORBELL_INT)
1677
			arcmsr_hbaA_doorbell_isr(acb);
1678
		if (outbound_intstatus & ARCMSR_MU_OUTBOUND_POSTQUEUE_INT)
1679
			arcmsr_hbaA_postqueue_isr(acb);
1680
		if (outbound_intstatus & ARCMSR_MU_OUTBOUND_MESSAGE0_INT)
1681
			arcmsr_hbaA_message_isr(acb);
1682 1683 1684 1685 1686 1687
		outbound_intstatus = readl(&reg->outbound_intstatus) &
			acb->outbound_int_enable;
	} while (outbound_intstatus & (ARCMSR_MU_OUTBOUND_DOORBELL_INT
		| ARCMSR_MU_OUTBOUND_POSTQUEUE_INT
		| ARCMSR_MU_OUTBOUND_MESSAGE0_INT));
	return IRQ_HANDLED;
1688 1689
}

1690
static int arcmsr_hbaB_handle_isr(struct AdapterControlBlock *acb)
1691 1692
{
	uint32_t outbound_doorbell;
A
Al Viro 已提交
1693
	struct MessageUnit_B *reg = acb->pmuB;
1694
	outbound_doorbell = readl(reg->iop2drv_doorbell) &
1695
				acb->outbound_int_enable;
1696
	if (!outbound_doorbell)
1697 1698 1699 1700 1701 1702 1703 1704 1705
		return IRQ_NONE;
	do {
		writel(~outbound_doorbell, reg->iop2drv_doorbell);
		writel(ARCMSR_DRV2IOP_END_OF_INTERRUPT, reg->drv2iop_doorbell);
		if (outbound_doorbell & ARCMSR_IOP2DRV_DATA_WRITE_OK)
			arcmsr_iop2drv_data_wrote_handle(acb);
		if (outbound_doorbell & ARCMSR_IOP2DRV_DATA_READ_OK)
			arcmsr_iop2drv_data_read_handle(acb);
		if (outbound_doorbell & ARCMSR_IOP2DRV_CDB_DONE)
1706
			arcmsr_hbaB_postqueue_isr(acb);
1707
		if (outbound_doorbell & ARCMSR_IOP2DRV_MESSAGE_CMD_DONE)
1708
			arcmsr_hbaB_message_isr(acb);
1709 1710 1711 1712 1713 1714 1715
		outbound_doorbell = readl(reg->iop2drv_doorbell) &
			acb->outbound_int_enable;
	} while (outbound_doorbell & (ARCMSR_IOP2DRV_DATA_WRITE_OK
		| ARCMSR_IOP2DRV_DATA_READ_OK
		| ARCMSR_IOP2DRV_CDB_DONE
		| ARCMSR_IOP2DRV_MESSAGE_CMD_DONE));
	return IRQ_HANDLED;
1716 1717
}

1718
static int arcmsr_hbaC_handle_isr(struct AdapterControlBlock *pACB)
1719 1720 1721 1722 1723 1724 1725 1726
{
	uint32_t host_interrupt_status;
	struct MessageUnit_C *phbcmu = (struct MessageUnit_C *)pACB->pmuC;
	/*
	*********************************************
	**   check outbound intstatus
	*********************************************
	*/
1727 1728 1729 1730 1731 1732 1733
	host_interrupt_status = readl(&phbcmu->host_int_status) &
		(ARCMSR_HBCMU_OUTBOUND_POSTQUEUE_ISR |
		ARCMSR_HBCMU_OUTBOUND_DOORBELL_ISR);
	if (!host_interrupt_status)
		return IRQ_NONE;
	do {
		if (host_interrupt_status & ARCMSR_HBCMU_OUTBOUND_DOORBELL_ISR)
1734
			arcmsr_hbaC_doorbell_isr(pACB);
1735 1736
		/* MU post queue interrupts*/
		if (host_interrupt_status & ARCMSR_HBCMU_OUTBOUND_POSTQUEUE_ISR)
1737
			arcmsr_hbaC_postqueue_isr(pACB);
1738 1739 1740 1741
		host_interrupt_status = readl(&phbcmu->host_int_status);
	} while (host_interrupt_status & (ARCMSR_HBCMU_OUTBOUND_POSTQUEUE_ISR |
		ARCMSR_HBCMU_OUTBOUND_DOORBELL_ISR));
	return IRQ_HANDLED;
1742
}
1743 1744 1745
static irqreturn_t arcmsr_interrupt(struct AdapterControlBlock *acb)
{
	switch (acb->adapter_type) {
1746
	case ACB_ADAPTER_TYPE_A:
1747
		return arcmsr_hbaA_handle_isr(acb);
1748
		break;
1749
	case ACB_ADAPTER_TYPE_B:
1750
		return arcmsr_hbaB_handle_isr(acb);
1751
		break;
1752
	case ACB_ADAPTER_TYPE_C:
1753
		return arcmsr_hbaC_handle_isr(acb);
1754 1755
	default:
		return IRQ_NONE;
1756 1757 1758 1759 1760 1761 1762 1763
	}
}

static void arcmsr_iop_parking(struct AdapterControlBlock *acb)
{
	if (acb) {
		/* stop adapter background rebuild */
		if (acb->acb_flags & ACB_F_MSG_START_BGRB) {
1764
			uint32_t intmask_org;
1765
			acb->acb_flags &= ~ACB_F_MSG_START_BGRB;
1766
			intmask_org = arcmsr_disable_outbound_ints(acb);
1767 1768
			arcmsr_stop_adapter_bgrb(acb);
			arcmsr_flush_adapter_cache(acb);
1769 1770 1771 1772 1773 1774 1775 1776 1777
			arcmsr_enable_outbound_ints(acb, intmask_org);
		}
	}
}

void arcmsr_post_ioctldata2iop(struct AdapterControlBlock *acb)
{
	int32_t wqbuf_firstindex, wqbuf_lastindex;
	uint8_t *pQbuffer;
A
Al Viro 已提交
1778 1779
	struct QBUFFER __iomem *pwbuffer;
	uint8_t __iomem *iop_data;
1780 1781 1782 1783 1784 1785 1786 1787 1788 1789 1790 1791 1792 1793
	int32_t allxfer_len = 0;
	pwbuffer = arcmsr_get_iop_wqbuffer(acb);
	iop_data = (uint8_t __iomem *)pwbuffer->data;
	if (acb->acb_flags & ACB_F_MESSAGE_WQBUFFER_READED) {
		acb->acb_flags &= (~ACB_F_MESSAGE_WQBUFFER_READED);
		wqbuf_firstindex = acb->wqbuf_firstindex;
		wqbuf_lastindex = acb->wqbuf_lastindex;
		while ((wqbuf_firstindex != wqbuf_lastindex) && (allxfer_len < 124)) {
			pQbuffer = &acb->wqbuffer[wqbuf_firstindex];
			memcpy(iop_data, pQbuffer, 1);
			wqbuf_firstindex++;
			wqbuf_firstindex %= ARCMSR_MAX_QBUFFER;
			iop_data++;
			allxfer_len++;
1794
		}
1795 1796 1797
		acb->wqbuf_firstindex = wqbuf_firstindex;
		pwbuffer->data_len = allxfer_len;
		arcmsr_iop_message_wrote(acb);
1798 1799 1800
	}
}

1801
static int arcmsr_iop_message_xfer(struct AdapterControlBlock *acb,
1802
					struct scsi_cmnd *cmd)
1803 1804 1805 1806
{
	struct CMD_MESSAGE_FIELD *pcmdmessagefld;
	int retvalue = 0, transfer_len = 0;
	char *buffer;
1807
	struct scatterlist *sg;
1808 1809 1810 1811
	uint32_t controlcode = (uint32_t ) cmd->cmnd[5] << 24 |
						(uint32_t ) cmd->cmnd[6] << 16 |
						(uint32_t ) cmd->cmnd[7] << 8  |
						(uint32_t ) cmd->cmnd[8];
1812
						/* 4 bytes: Areca io control code */
1813
	sg = scsi_sglist(cmd);
1814
	buffer = kmap_atomic(sg_page(sg)) + sg->offset;
1815 1816 1817
	if (scsi_sg_count(cmd) > 1) {
		retvalue = ARCMSR_MESSAGE_FAIL;
		goto message_out;
1818
	}
1819 1820
	transfer_len += sg->length;

1821 1822 1823 1824 1825 1826
	if (transfer_len > sizeof(struct CMD_MESSAGE_FIELD)) {
		retvalue = ARCMSR_MESSAGE_FAIL;
		goto message_out;
	}
	pcmdmessagefld = (struct CMD_MESSAGE_FIELD *) buffer;
	switch(controlcode) {
1827

1828
	case ARCMSR_MESSAGE_READ_RQBUFFER: {
1829
		unsigned char *ver_addr;
1830 1831 1832
		uint8_t *pQbuffer, *ptmpQbuffer;
		int32_t allxfer_len = 0;

1833 1834
		ver_addr = kmalloc(1032, GFP_ATOMIC);
		if (!ver_addr) {
1835 1836 1837
			retvalue = ARCMSR_MESSAGE_FAIL;
			goto message_out;
		}
1838
				
1839
		ptmpQbuffer = ver_addr;
1840 1841 1842 1843 1844 1845 1846 1847 1848 1849
		while ((acb->rqbuf_firstindex != acb->rqbuf_lastindex)
			&& (allxfer_len < 1031)) {
			pQbuffer = &acb->rqbuffer[acb->rqbuf_firstindex];
			memcpy(ptmpQbuffer, pQbuffer, 1);
			acb->rqbuf_firstindex++;
			acb->rqbuf_firstindex %= ARCMSR_MAX_QBUFFER;
			ptmpQbuffer++;
			allxfer_len++;
		}
		if (acb->acb_flags & ACB_F_IOPDATA_OVERFLOW) {
1850

A
Al Viro 已提交
1851 1852
			struct QBUFFER __iomem *prbuffer;
			uint8_t __iomem *iop_data;
1853 1854 1855 1856
			int32_t iop_len;

			acb->acb_flags &= ~ACB_F_IOPDATA_OVERFLOW;
			prbuffer = arcmsr_get_iop_rqbuffer(acb);
A
Al Viro 已提交
1857
			iop_data = prbuffer->data;
1858 1859 1860 1861 1862 1863 1864
			iop_len = readl(&prbuffer->data_len);
			while (iop_len > 0) {
				acb->rqbuffer[acb->rqbuf_lastindex] = readb(iop_data);
				acb->rqbuf_lastindex++;
				acb->rqbuf_lastindex %= ARCMSR_MAX_QBUFFER;
				iop_data++;
				iop_len--;
1865
			}
1866 1867
			arcmsr_iop_message_read(acb);
		}
1868
		memcpy(pcmdmessagefld->messagedatabuffer, ver_addr, allxfer_len);
1869
		pcmdmessagefld->cmdmessage.Length = allxfer_len;
1870
		if(acb->fw_flag == FW_DEADLOCK) {
1871
			pcmdmessagefld->cmdmessage.ReturnCode = ARCMSR_MESSAGE_RETURNCODE_BUS_HANG_ON;
1872 1873
		}else{
			pcmdmessagefld->cmdmessage.ReturnCode = ARCMSR_MESSAGE_RETURNCODE_OK;
1874
		}
1875
		kfree(ver_addr);
1876 1877 1878
		}
		break;

1879
	case ARCMSR_MESSAGE_WRITE_WQBUFFER: {
1880
		unsigned char *ver_addr;
1881 1882 1883
		int32_t my_empty_len, user_len, wqbuf_firstindex, wqbuf_lastindex;
		uint8_t *pQbuffer, *ptmpuserbuffer;

1884 1885
		ver_addr = kmalloc(1032, GFP_ATOMIC);
		if (!ver_addr) {
1886 1887 1888
			retvalue = ARCMSR_MESSAGE_FAIL;
			goto message_out;
		}
1889 1890
		if(acb->fw_flag == FW_DEADLOCK) {
			pcmdmessagefld->cmdmessage.ReturnCode = 
1891
			ARCMSR_MESSAGE_RETURNCODE_BUS_HANG_ON;
1892 1893
		}else{
			pcmdmessagefld->cmdmessage.ReturnCode = 
1894
			ARCMSR_MESSAGE_RETURNCODE_OK;
1895
		}
1896
		ptmpuserbuffer = ver_addr;
1897 1898 1899 1900 1901 1902 1903 1904 1905 1906 1907 1908 1909 1910 1911 1912 1913 1914 1915 1916 1917 1918 1919 1920 1921 1922 1923 1924 1925 1926 1927 1928 1929 1930 1931
		user_len = pcmdmessagefld->cmdmessage.Length;
		memcpy(ptmpuserbuffer, pcmdmessagefld->messagedatabuffer, user_len);
		wqbuf_lastindex = acb->wqbuf_lastindex;
		wqbuf_firstindex = acb->wqbuf_firstindex;
		if (wqbuf_lastindex != wqbuf_firstindex) {
			struct SENSE_DATA *sensebuffer =
				(struct SENSE_DATA *)cmd->sense_buffer;
			arcmsr_post_ioctldata2iop(acb);
			/* has error report sensedata */
			sensebuffer->ErrorCode = 0x70;
			sensebuffer->SenseKey = ILLEGAL_REQUEST;
			sensebuffer->AdditionalSenseLength = 0x0A;
			sensebuffer->AdditionalSenseCode = 0x20;
			sensebuffer->Valid = 1;
			retvalue = ARCMSR_MESSAGE_FAIL;
		} else {
			my_empty_len = (wqbuf_firstindex-wqbuf_lastindex - 1)
				&(ARCMSR_MAX_QBUFFER - 1);
			if (my_empty_len >= user_len) {
				while (user_len > 0) {
					pQbuffer =
					&acb->wqbuffer[acb->wqbuf_lastindex];
					memcpy(pQbuffer, ptmpuserbuffer, 1);
					acb->wqbuf_lastindex++;
					acb->wqbuf_lastindex %= ARCMSR_MAX_QBUFFER;
					ptmpuserbuffer++;
					user_len--;
				}
				if (acb->acb_flags & ACB_F_MESSAGE_WQBUFFER_CLEARED) {
					acb->acb_flags &=
						~ACB_F_MESSAGE_WQBUFFER_CLEARED;
					arcmsr_post_ioctldata2iop(acb);
				}
			} else {
				/* has error report sensedata */
1932 1933 1934 1935 1936 1937 1938 1939
				struct SENSE_DATA *sensebuffer =
					(struct SENSE_DATA *)cmd->sense_buffer;
				sensebuffer->ErrorCode = 0x70;
				sensebuffer->SenseKey = ILLEGAL_REQUEST;
				sensebuffer->AdditionalSenseLength = 0x0A;
				sensebuffer->AdditionalSenseCode = 0x20;
				sensebuffer->Valid = 1;
				retvalue = ARCMSR_MESSAGE_FAIL;
1940
			}
1941
			}
1942
			kfree(ver_addr);
1943 1944
		}
		break;
1945

1946
	case ARCMSR_MESSAGE_CLEAR_RQBUFFER: {
1947 1948 1949 1950 1951 1952 1953 1954 1955
		uint8_t *pQbuffer = acb->rqbuffer;
		if (acb->acb_flags & ACB_F_IOPDATA_OVERFLOW) {
			acb->acb_flags &= ~ACB_F_IOPDATA_OVERFLOW;
			arcmsr_iop_message_read(acb);
		}
		acb->acb_flags |= ACB_F_MESSAGE_RQBUFFER_CLEARED;
		acb->rqbuf_firstindex = 0;
		acb->rqbuf_lastindex = 0;
		memset(pQbuffer, 0, ARCMSR_MAX_QBUFFER);
1956
		if(acb->fw_flag == FW_DEADLOCK) {
1957 1958
			pcmdmessagefld->cmdmessage.ReturnCode =
			ARCMSR_MESSAGE_RETURNCODE_BUS_HANG_ON;
1959
		}else{
1960 1961 1962
			pcmdmessagefld->cmdmessage.ReturnCode =
			ARCMSR_MESSAGE_RETURNCODE_OK;
		}
1963 1964
		}
		break;
1965

1966
	case ARCMSR_MESSAGE_CLEAR_WQBUFFER: {
1967
		uint8_t *pQbuffer = acb->wqbuffer;
1968
		if(acb->fw_flag == FW_DEADLOCK) {
1969 1970
			pcmdmessagefld->cmdmessage.ReturnCode =
			ARCMSR_MESSAGE_RETURNCODE_BUS_HANG_ON;
1971
		}else{
1972 1973
			pcmdmessagefld->cmdmessage.ReturnCode =
			ARCMSR_MESSAGE_RETURNCODE_OK;
1974
		}
1975

1976 1977 1978 1979 1980 1981 1982 1983 1984 1985
		if (acb->acb_flags & ACB_F_IOPDATA_OVERFLOW) {
			acb->acb_flags &= ~ACB_F_IOPDATA_OVERFLOW;
			arcmsr_iop_message_read(acb);
		}
		acb->acb_flags |=
			(ACB_F_MESSAGE_WQBUFFER_CLEARED |
				ACB_F_MESSAGE_WQBUFFER_READED);
		acb->wqbuf_firstindex = 0;
		acb->wqbuf_lastindex = 0;
		memset(pQbuffer, 0, ARCMSR_MAX_QBUFFER);
1986 1987
		}
		break;
1988

1989
	case ARCMSR_MESSAGE_CLEAR_ALLQBUFFER: {
1990
		uint8_t *pQbuffer;
1991

1992 1993 1994 1995 1996 1997 1998 1999 2000 2001 2002 2003 2004 2005 2006 2007
		if (acb->acb_flags & ACB_F_IOPDATA_OVERFLOW) {
			acb->acb_flags &= ~ACB_F_IOPDATA_OVERFLOW;
			arcmsr_iop_message_read(acb);
		}
		acb->acb_flags |=
			(ACB_F_MESSAGE_WQBUFFER_CLEARED
			| ACB_F_MESSAGE_RQBUFFER_CLEARED
			| ACB_F_MESSAGE_WQBUFFER_READED);
		acb->rqbuf_firstindex = 0;
		acb->rqbuf_lastindex = 0;
		acb->wqbuf_firstindex = 0;
		acb->wqbuf_lastindex = 0;
		pQbuffer = acb->rqbuffer;
		memset(pQbuffer, 0, sizeof(struct QBUFFER));
		pQbuffer = acb->wqbuffer;
		memset(pQbuffer, 0, sizeof(struct QBUFFER));
2008
		if(acb->fw_flag == FW_DEADLOCK) {
2009 2010
			pcmdmessagefld->cmdmessage.ReturnCode =
			ARCMSR_MESSAGE_RETURNCODE_BUS_HANG_ON;
2011
		}else{
2012 2013 2014
			pcmdmessagefld->cmdmessage.ReturnCode =
			ARCMSR_MESSAGE_RETURNCODE_OK;
		}
2015 2016
		}
		break;
2017

2018
	case ARCMSR_MESSAGE_RETURN_CODE_3F: {
2019
		if(acb->fw_flag == FW_DEADLOCK) {
2020 2021
			pcmdmessagefld->cmdmessage.ReturnCode =
			ARCMSR_MESSAGE_RETURNCODE_BUS_HANG_ON;
2022
		}else{
2023 2024
			pcmdmessagefld->cmdmessage.ReturnCode =
			ARCMSR_MESSAGE_RETURNCODE_3F;
2025 2026
		}
		break;
2027
		}
2028
	case ARCMSR_MESSAGE_SAY_HELLO: {
2029
		int8_t *hello_string = "Hello! I am ARCMSR";
2030
		if(acb->fw_flag == FW_DEADLOCK) {
2031 2032
			pcmdmessagefld->cmdmessage.ReturnCode =
			ARCMSR_MESSAGE_RETURNCODE_BUS_HANG_ON;
2033
		}else{
2034 2035
			pcmdmessagefld->cmdmessage.ReturnCode =
			ARCMSR_MESSAGE_RETURNCODE_OK;
2036
		}
2037 2038
		memcpy(pcmdmessagefld->messagedatabuffer, hello_string
			, (int16_t)strlen(hello_string));
2039 2040
		}
		break;
2041

2042
	case ARCMSR_MESSAGE_SAY_GOODBYE:
2043
		if(acb->fw_flag == FW_DEADLOCK) {
2044 2045 2046
			pcmdmessagefld->cmdmessage.ReturnCode =
			ARCMSR_MESSAGE_RETURNCODE_BUS_HANG_ON;
		}
2047 2048
		arcmsr_iop_parking(acb);
		break;
2049

2050
	case ARCMSR_MESSAGE_FLUSH_ADAPTER_CACHE:
2051
		if(acb->fw_flag == FW_DEADLOCK) {
2052 2053 2054
			pcmdmessagefld->cmdmessage.ReturnCode =
			ARCMSR_MESSAGE_RETURNCODE_BUS_HANG_ON;
		}
2055 2056
		arcmsr_flush_adapter_cache(acb);
		break;
2057

2058 2059 2060
	default:
		retvalue = ARCMSR_MESSAGE_FAIL;
	}
2061
	message_out:
2062
	sg = scsi_sglist(cmd);
2063
	kunmap_atomic(buffer - sg->offset);
2064 2065 2066 2067 2068 2069 2070
	return retvalue;
}

static struct CommandControlBlock *arcmsr_get_freeccb(struct AdapterControlBlock *acb)
{
	struct list_head *head = &acb->ccb_free_list;
	struct CommandControlBlock *ccb = NULL;
2071 2072
	unsigned long flags;
	spin_lock_irqsave(&acb->ccblist_lock, flags);
2073 2074
	if (!list_empty(head)) {
		ccb = list_entry(head->next, struct CommandControlBlock, list);
2075
		list_del_init(&ccb->list);
2076
	}else{
2077 2078
		spin_unlock_irqrestore(&acb->ccblist_lock, flags);
		return 0;
2079
	}
2080
	spin_unlock_irqrestore(&acb->ccblist_lock, flags);
2081 2082 2083 2084 2085 2086 2087 2088 2089 2090
	return ccb;
}

static void arcmsr_handle_virtual_command(struct AdapterControlBlock *acb,
		struct scsi_cmnd *cmd)
{
	switch (cmd->cmnd[0]) {
	case INQUIRY: {
		unsigned char inqdata[36];
		char *buffer;
2091
		struct scatterlist *sg;
2092 2093 2094 2095 2096 2097 2098 2099 2100 2101 2102

		if (cmd->device->lun) {
			cmd->result = (DID_TIME_OUT << 16);
			cmd->scsi_done(cmd);
			return;
		}
		inqdata[0] = TYPE_PROCESSOR;
		/* Periph Qualifier & Periph Dev Type */
		inqdata[1] = 0;
		/* rem media bit & Dev Type Modifier */
		inqdata[2] = 0;
2103
		/* ISO, ECMA, & ANSI versions */
2104 2105 2106 2107 2108 2109 2110 2111
		inqdata[4] = 31;
		/* length of additional data */
		strncpy(&inqdata[8], "Areca   ", 8);
		/* Vendor Identification */
		strncpy(&inqdata[16], "RAID controller ", 16);
		/* Product Identification */
		strncpy(&inqdata[32], "R001", 4); /* Product Revision */

2112
		sg = scsi_sglist(cmd);
2113
		buffer = kmap_atomic(sg_page(sg)) + sg->offset;
2114

2115
		memcpy(buffer, inqdata, sizeof(inqdata));
2116
		sg = scsi_sglist(cmd);
2117
		kunmap_atomic(buffer - sg->offset);
2118 2119 2120 2121 2122 2123 2124 2125 2126 2127 2128 2129 2130 2131 2132 2133

		cmd->scsi_done(cmd);
	}
	break;
	case WRITE_BUFFER:
	case READ_BUFFER: {
		if (arcmsr_iop_message_xfer(acb, cmd))
			cmd->result = (DID_ERROR << 16);
		cmd->scsi_done(cmd);
	}
	break;
	default:
		cmd->scsi_done(cmd);
	}
}

J
Jeff Garzik 已提交
2134
static int arcmsr_queue_command_lck(struct scsi_cmnd *cmd,
2135 2136 2137
	void (* done)(struct scsi_cmnd *))
{
	struct Scsi_Host *host = cmd->device->host;
2138
	struct AdapterControlBlock *acb = (struct AdapterControlBlock *) host->hostdata;
2139 2140 2141
	struct CommandControlBlock *ccb;
	int target = cmd->device->id;
	int lun = cmd->device->lun;
2142
	uint8_t scsicmd = cmd->cmnd[0];
2143 2144 2145
	cmd->scsi_done = done;
	cmd->host_scribble = NULL;
	cmd->result = 0;
2146 2147 2148
	if ((scsicmd == SYNCHRONIZE_CACHE) ||(scsicmd == SEND_DIAGNOSTIC)){
		if(acb->devstate[target][lun] == ARECA_RAID_GONE) {
    			cmd->result = (DID_NO_CONNECT << 16);
2149 2150 2151 2152
		}
		cmd->scsi_done(cmd);
		return 0;
	}
2153
	if (target == 16) {
2154 2155 2156 2157 2158 2159 2160
		/* virtual device for iop message transfer */
		arcmsr_handle_virtual_command(acb, cmd);
		return 0;
	}
	ccb = arcmsr_get_freeccb(acb);
	if (!ccb)
		return SCSI_MLQUEUE_HOST_BUSY;
2161
	if (arcmsr_build_ccb( acb, ccb, cmd ) == FAILED) {
N
Nick Cheng 已提交
2162 2163 2164 2165
		cmd->result = (DID_ERROR << 16) | (RESERVATION_CONFLICT << 1);
		cmd->scsi_done(cmd);
		return 0;
	}
2166 2167 2168 2169
	arcmsr_post_ccb(acb, ccb);
	return 0;
}

J
Jeff Garzik 已提交
2170 2171
static DEF_SCSI_QCMD(arcmsr_queue_command)

2172
static bool arcmsr_hbaA_get_config(struct AdapterControlBlock *acb)
2173
{
A
Al Viro 已提交
2174
	struct MessageUnit_A __iomem *reg = acb->pmuA;
2175 2176
	char *acb_firm_model = acb->firm_model;
	char *acb_firm_version = acb->firm_version;
2177
	char *acb_device_map = acb->device_map;
A
Al Viro 已提交
2178 2179
	char __iomem *iop_firm_model = (char __iomem *)(&reg->message_rwbuffer[15]);
	char __iomem *iop_firm_version = (char __iomem *)(&reg->message_rwbuffer[17]);
2180
	char __iomem *iop_device_map = (char __iomem *)(&reg->message_rwbuffer[21]);
2181 2182
	int count;
	writel(ARCMSR_INBOUND_MESG0_GET_CONFIG, &reg->inbound_msgaddr0);
2183
	if (!arcmsr_hbaA_wait_msgint_ready(acb)) {
2184 2185
		printk(KERN_NOTICE "arcmsr%d: wait 'get adapter firmware \
			miscellaneous data' timeout \n", acb->host->host_no);
2186
		return false;
2187
	}
2188
	count = 8;
2189
	while (count){
2190 2191 2192 2193 2194
		*acb_firm_model = readb(iop_firm_model);
		acb_firm_model++;
		iop_firm_model++;
		count--;
	}
2195

2196
	count = 16;
2197
	while (count){
2198 2199 2200 2201 2202
		*acb_firm_version = readb(iop_firm_version);
		acb_firm_version++;
		iop_firm_version++;
		count--;
	}
2203

2204 2205 2206 2207 2208 2209 2210
	count=16;
	while(count){
		*acb_device_map = readb(iop_device_map);
		acb_device_map++;
		iop_device_map++;
		count--;
	}
2211
	pr_notice("Areca RAID Controller%d: Model %s, F/W %s\n",
2212
		acb->host->host_no,
2213 2214
		acb->firm_model,
		acb->firm_version);
2215
	acb->signature = readl(&reg->message_rwbuffer[0]);
2216 2217 2218 2219
	acb->firm_request_len = readl(&reg->message_rwbuffer[1]);
	acb->firm_numbers_queue = readl(&reg->message_rwbuffer[2]);
	acb->firm_sdram_size = readl(&reg->message_rwbuffer[3]);
	acb->firm_hd_channels = readl(&reg->message_rwbuffer[4]);
2220 2221
	acb->firm_cfg_version = readl(&reg->message_rwbuffer[25]);  /*firm_cfg_version,25,100-103*/
	return true;
2222
}
2223
static bool arcmsr_hbaB_get_config(struct AdapterControlBlock *acb)
2224
{
A
Al Viro 已提交
2225
	struct MessageUnit_B *reg = acb->pmuB;
2226 2227 2228
	struct pci_dev *pdev = acb->pdev;
	void *dma_coherent;
	dma_addr_t dma_coherent_handle;
2229 2230
	char *acb_firm_model = acb->firm_model;
	char *acb_firm_version = acb->firm_version;
2231
	char *acb_device_map = acb->device_map;
2232
	char __iomem *iop_firm_model;
2233
	/*firm_model,15,60-67*/
2234
	char __iomem *iop_firm_version;
2235
	/*firm_version,17,68-83*/
2236
	char __iomem *iop_device_map;
2237
	/*firm_version,21,84-99*/
2238
	int count;
2239
	dma_coherent = dma_alloc_coherent(&pdev->dev, sizeof(struct MessageUnit_B), &dma_coherent_handle, GFP_KERNEL);
2240
	if (!dma_coherent){
2241 2242 2243
		printk(KERN_NOTICE "arcmsr%d: dma_alloc_coherent got error for hbb mu\n", acb->host->host_no);
		return false;
	}
2244
	acb->dma_coherent_handle2 = dma_coherent_handle;
2245 2246
	reg = (struct MessageUnit_B *)dma_coherent;
	acb->pmuB = reg;
2247
	reg->drv2iop_doorbell= (uint32_t __iomem *)((unsigned long)acb->mem_base0 + ARCMSR_DRV2IOP_DOORBELL);
2248 2249 2250 2251 2252 2253 2254 2255 2256 2257 2258
	reg->drv2iop_doorbell_mask = (uint32_t __iomem *)((unsigned long)acb->mem_base0 + ARCMSR_DRV2IOP_DOORBELL_MASK);
	reg->iop2drv_doorbell = (uint32_t __iomem *)((unsigned long)acb->mem_base0 + ARCMSR_IOP2DRV_DOORBELL);
	reg->iop2drv_doorbell_mask = (uint32_t __iomem *)((unsigned long)acb->mem_base0 + ARCMSR_IOP2DRV_DOORBELL_MASK);
	reg->message_wbuffer = (uint32_t __iomem *)((unsigned long)acb->mem_base1 + ARCMSR_MESSAGE_WBUFFER);
	reg->message_rbuffer =  (uint32_t __iomem *)((unsigned long)acb->mem_base1 + ARCMSR_MESSAGE_RBUFFER);
	reg->message_rwbuffer = (uint32_t __iomem *)((unsigned long)acb->mem_base1 + ARCMSR_MESSAGE_RWBUFFER);
	iop_firm_model = (char __iomem *)(&reg->message_rwbuffer[15]);	/*firm_model,15,60-67*/
	iop_firm_version = (char __iomem *)(&reg->message_rwbuffer[17]);	/*firm_version,17,68-83*/
	iop_device_map = (char __iomem *)(&reg->message_rwbuffer[21]);	/*firm_version,21,84-99*/

	writel(ARCMSR_MESSAGE_GET_CONFIG, reg->drv2iop_doorbell);
2259
	if (!arcmsr_hbaB_wait_msgint_ready(acb)) {
2260 2261
		printk(KERN_NOTICE "arcmsr%d: wait 'get adapter firmware \
			miscellaneous data' timeout \n", acb->host->host_no);
2262
		return false;
2263 2264
	}
	count = 8;
2265
	while (count){
2266 2267 2268 2269 2270 2271
		*acb_firm_model = readb(iop_firm_model);
		acb_firm_model++;
		iop_firm_model++;
		count--;
	}
	count = 16;
2272
	while (count){
2273 2274 2275 2276 2277 2278
		*acb_firm_version = readb(iop_firm_version);
		acb_firm_version++;
		iop_firm_version++;
		count--;
	}

2279 2280 2281 2282 2283 2284 2285 2286
	count = 16;
	while(count){
		*acb_device_map = readb(iop_device_map);
		acb_device_map++;
		iop_device_map++;
		count--;
	}
	
2287
	pr_notice("Areca RAID Controller%d: Model %s, F/W %s\n",
2288
		acb->host->host_no,
2289 2290
		acb->firm_model,
		acb->firm_version);
2291

2292
	acb->signature = readl(&reg->message_rwbuffer[1]);
2293
	/*firm_signature,1,00-03*/
2294
	acb->firm_request_len = readl(&reg->message_rwbuffer[2]);
2295
	/*firm_request_len,1,04-07*/
2296
	acb->firm_numbers_queue = readl(&reg->message_rwbuffer[3]);
2297
	/*firm_numbers_queue,2,08-11*/
2298
	acb->firm_sdram_size = readl(&reg->message_rwbuffer[4]);
2299
	/*firm_sdram_size,3,12-15*/
2300
	acb->firm_hd_channels = readl(&reg->message_rwbuffer[5]);
2301
	/*firm_ide_channels,4,16-19*/
2302 2303 2304
	acb->firm_cfg_version = readl(&reg->message_rwbuffer[25]);  /*firm_cfg_version,25,100-103*/
	/*firm_ide_channels,4,16-19*/
	return true;
2305
}
2306

2307
static bool arcmsr_hbaC_get_config(struct AdapterControlBlock *pACB)
2308 2309 2310 2311 2312 2313 2314 2315 2316 2317 2318 2319 2320 2321 2322 2323 2324 2325 2326 2327 2328 2329 2330 2331 2332 2333 2334 2335 2336 2337 2338 2339 2340 2341 2342 2343 2344 2345 2346 2347 2348 2349 2350 2351 2352
{
	uint32_t intmask_org, Index, firmware_state = 0;
	struct MessageUnit_C *reg = pACB->pmuC;
	char *acb_firm_model = pACB->firm_model;
	char *acb_firm_version = pACB->firm_version;
	char *iop_firm_model = (char *)(&reg->msgcode_rwbuffer[15]);    /*firm_model,15,60-67*/
	char *iop_firm_version = (char *)(&reg->msgcode_rwbuffer[17]);  /*firm_version,17,68-83*/
	int count;
	/* disable all outbound interrupt */
	intmask_org = readl(&reg->host_int_mask); /* disable outbound message0 int */
	writel(intmask_org|ARCMSR_HBCMU_ALL_INTMASKENABLE, &reg->host_int_mask);
	/* wait firmware ready */
	do {
		firmware_state = readl(&reg->outbound_msgaddr1);
	} while ((firmware_state & ARCMSR_HBCMU_MESSAGE_FIRMWARE_OK) == 0);
	/* post "get config" instruction */
	writel(ARCMSR_INBOUND_MESG0_GET_CONFIG, &reg->inbound_msgaddr0);
	writel(ARCMSR_HBCMU_DRV2IOP_MESSAGE_CMD_DONE, &reg->inbound_doorbell);
	/* wait message ready */
	for (Index = 0; Index < 2000; Index++) {
		if (readl(&reg->outbound_doorbell) & ARCMSR_HBCMU_IOP2DRV_MESSAGE_CMD_DONE) {
			writel(ARCMSR_HBCMU_IOP2DRV_MESSAGE_CMD_DONE_DOORBELL_CLEAR, &reg->outbound_doorbell_clear);/*clear interrupt*/
			break;
		}
		udelay(10);
	} /*max 1 seconds*/
	if (Index >= 2000) {
		printk(KERN_NOTICE "arcmsr%d: wait 'get adapter firmware \
			miscellaneous data' timeout \n", pACB->host->host_no);
		return false;
	}
	count = 8;
	while (count) {
		*acb_firm_model = readb(iop_firm_model);
		acb_firm_model++;
		iop_firm_model++;
		count--;
	}
	count = 16;
	while (count) {
		*acb_firm_version = readb(iop_firm_version);
		acb_firm_version++;
		iop_firm_version++;
		count--;
	}
2353
	pr_notice("Areca RAID Controller%d: Model %s, F/W %s\n",
2354
		pACB->host->host_no,
2355 2356
		pACB->firm_model,
		pACB->firm_version);
2357 2358 2359 2360 2361 2362 2363 2364
	pACB->firm_request_len = readl(&reg->msgcode_rwbuffer[1]);   /*firm_request_len,1,04-07*/
	pACB->firm_numbers_queue = readl(&reg->msgcode_rwbuffer[2]); /*firm_numbers_queue,2,08-11*/
	pACB->firm_sdram_size = readl(&reg->msgcode_rwbuffer[3]);    /*firm_sdram_size,3,12-15*/
	pACB->firm_hd_channels = readl(&reg->msgcode_rwbuffer[4]);  /*firm_ide_channels,4,16-19*/
	pACB->firm_cfg_version = readl(&reg->msgcode_rwbuffer[25]);  /*firm_cfg_version,25,100-103*/
	/*all interrupt service will be enable at arcmsr_iop_init*/
	return true;
}
2365
static bool arcmsr_get_firmware_spec(struct AdapterControlBlock *acb)
2366
{
2367 2368 2369 2370
	bool rtn = false;

	switch (acb->adapter_type) {
	case ACB_ADAPTER_TYPE_A:
2371
		rtn = arcmsr_hbaA_get_config(acb);
2372 2373
		break;
	case ACB_ADAPTER_TYPE_B:
2374
		rtn = arcmsr_hbaB_get_config(acb);
2375 2376
		break;
	case ACB_ADAPTER_TYPE_C:
2377
		rtn = arcmsr_hbaC_get_config(acb);
2378 2379 2380 2381 2382 2383
		break;
	default:
		break;
	}
	if (acb->firm_numbers_queue > ARCMSR_MAX_OUTSTANDING_CMD)
		acb->maxOutstanding = ARCMSR_MAX_OUTSTANDING_CMD;
2384
	else
2385 2386 2387
		acb->maxOutstanding = acb->firm_numbers_queue - 1;
	acb->host->can_queue = acb->maxOutstanding;
	return rtn;
2388 2389
}

2390
static int arcmsr_hbaA_polling_ccbdone(struct AdapterControlBlock *acb,
2391 2392
	struct CommandControlBlock *poll_ccb)
{
A
Al Viro 已提交
2393
	struct MessageUnit_A __iomem *reg = acb->pmuA;
2394
	struct CommandControlBlock *ccb;
2395
	struct ARCMSR_CDB *arcmsr_cdb;
2396
	uint32_t flag_ccb, outbound_intstatus, poll_ccb_done = 0, poll_count = 0;
2397
	int rtn;
2398
	bool error;
2399
	polling_hba_ccb_retry:
2400
	poll_count++;
2401
	outbound_intstatus = readl(&reg->outbound_intstatus) & acb->outbound_int_enable;
2402 2403 2404
	writel(outbound_intstatus, &reg->outbound_intstatus);/*clear interrupt*/
	while (1) {
		if ((flag_ccb = readl(&reg->outbound_queueport)) == 0xFFFFFFFF) {
2405
			if (poll_ccb_done){
2406
				rtn = SUCCESS;
2407
				break;
2408 2409 2410
			}else {
				msleep(25);
				if (poll_count > 100){
2411
					rtn = FAILED;
2412
					break;
2413
				}
2414
				goto polling_hba_ccb_retry;
2415 2416
			}
		}
2417 2418
		arcmsr_cdb = (struct ARCMSR_CDB *)(acb->vir2phy_offset + (flag_ccb << 5));
		ccb = container_of(arcmsr_cdb, struct CommandControlBlock, arcmsr_cdb);
2419
		poll_ccb_done |= (ccb == poll_ccb) ? 1 : 0;
2420 2421 2422
		if ((ccb->acb != acb) || (ccb->startdone != ARCMSR_CCB_START)) {
			if ((ccb->startdone == ARCMSR_CCB_ABORTED) || (ccb == poll_ccb)) {
				printk(KERN_NOTICE "arcmsr%d: scsi id = %d lun = %d ccb = '0x%p'"
2423 2424 2425
					" poll command abort successfully \n"
					, acb->host->host_no
					, ccb->pcmd->device->id
H
Hannes Reinecke 已提交
2426
					, (u32)ccb->pcmd->device->lun
2427 2428
					, ccb);
				ccb->pcmd->result = DID_ABORT << 16;
2429
				arcmsr_ccb_complete(ccb);
2430 2431
				continue;
			}
2432 2433
			printk(KERN_NOTICE "arcmsr%d: polling get an illegal ccb"
				" command done ccb = '0x%p'"
2434
				"ccboutstandingcount = %d \n"
2435 2436 2437 2438
				, acb->host->host_no
				, ccb
				, atomic_read(&acb->ccboutstandingcount));
			continue;
2439 2440 2441
		}
		error = (flag_ccb & ARCMSR_CCBREPLY_FLAG_ERROR_MODE0) ? true : false;
		arcmsr_report_ccb_state(acb, ccb, error);
2442
	}
2443 2444
	return rtn;
}
2445

2446
static int arcmsr_hbaB_polling_ccbdone(struct AdapterControlBlock *acb,
2447 2448
					struct CommandControlBlock *poll_ccb)
{
2449
	struct MessageUnit_B *reg = acb->pmuB;
2450
	struct ARCMSR_CDB *arcmsr_cdb;
2451 2452
	struct CommandControlBlock *ccb;
	uint32_t flag_ccb, poll_ccb_done = 0, poll_count = 0;
2453
	int index, rtn;
2454
	bool error;
2455
	polling_hbb_ccb_retry:
2456

2457 2458
	poll_count++;
	/* clear doorbell interrupt */
2459
	writel(ARCMSR_DOORBELL_INT_CLEAR_PATTERN, reg->iop2drv_doorbell);
2460 2461 2462 2463
	while(1){
		index = reg->doneq_index;
		if ((flag_ccb = readl(&reg->done_qbuffer[index])) == 0) {
			if (poll_ccb_done){
2464
				rtn = SUCCESS;
2465 2466 2467 2468
				break;
			}else {
				msleep(25);
				if (poll_count > 100){
2469
					rtn = FAILED;
2470
					break;
2471
				}
2472
				goto polling_hbb_ccb_retry;
2473
			}
2474 2475 2476 2477 2478 2479 2480
		}
		writel(0, &reg->done_qbuffer[index]);
		index++;
		/*if last index number set it to 0 */
		index %= ARCMSR_MAX_HBB_POSTQUEUE;
		reg->doneq_index = index;
		/* check if command done with no error*/
2481 2482
		arcmsr_cdb = (struct ARCMSR_CDB *)(acb->vir2phy_offset + (flag_ccb << 5));
		ccb = container_of(arcmsr_cdb, struct CommandControlBlock, arcmsr_cdb);
2483
		poll_ccb_done |= (ccb == poll_ccb) ? 1 : 0;
2484 2485
		if ((ccb->acb != acb) || (ccb->startdone != ARCMSR_CCB_START)) {
			if ((ccb->startdone == ARCMSR_CCB_ABORTED) || (ccb == poll_ccb)) {
2486 2487
				printk(KERN_NOTICE "arcmsr%d: scsi id = %d lun = %d ccb = '0x%p'"
					" poll command abort successfully \n"
2488 2489
					,acb->host->host_no
					,ccb->pcmd->device->id
H
Hannes Reinecke 已提交
2490
					,(u32)ccb->pcmd->device->lun
2491 2492
					,ccb);
				ccb->pcmd->result = DID_ABORT << 16;
2493
				arcmsr_ccb_complete(ccb);
2494 2495 2496 2497 2498 2499 2500 2501 2502 2503 2504 2505 2506 2507 2508 2509
				continue;
			}
			printk(KERN_NOTICE "arcmsr%d: polling get an illegal ccb"
				" command done ccb = '0x%p'"
				"ccboutstandingcount = %d \n"
				, acb->host->host_no
				, ccb
				, atomic_read(&acb->ccboutstandingcount));
			continue;
		} 
		error = (flag_ccb & ARCMSR_CCBREPLY_FLAG_ERROR_MODE0) ? true : false;
		arcmsr_report_ccb_state(acb, ccb, error);
	}
	return rtn;
}

2510 2511
static int arcmsr_hbaC_polling_ccbdone(struct AdapterControlBlock *acb,
		struct CommandControlBlock *poll_ccb)
2512 2513 2514 2515 2516 2517 2518 2519 2520 2521 2522 2523 2524 2525 2526 2527 2528 2529 2530 2531
{
	struct MessageUnit_C *reg = (struct MessageUnit_C *)acb->pmuC;
	uint32_t flag_ccb, ccb_cdb_phy;
	struct ARCMSR_CDB *arcmsr_cdb;
	bool error;
	struct CommandControlBlock *pCCB;
	uint32_t poll_ccb_done = 0, poll_count = 0;
	int rtn;
polling_hbc_ccb_retry:
	poll_count++;
	while (1) {
		if ((readl(&reg->host_int_status) & ARCMSR_HBCMU_OUTBOUND_POSTQUEUE_ISR) == 0) {
			if (poll_ccb_done) {
				rtn = SUCCESS;
				break;
			} else {
				msleep(25);
				if (poll_count > 100) {
					rtn = FAILED;
					break;
2532
				}
2533 2534 2535 2536 2537 2538 2539
				goto polling_hbc_ccb_retry;
			}
		}
		flag_ccb = readl(&reg->outbound_queueport_low);
		ccb_cdb_phy = (flag_ccb & 0xFFFFFFF0);
		arcmsr_cdb = (struct ARCMSR_CDB *)(acb->vir2phy_offset + ccb_cdb_phy);/*frame must be 32 bytes aligned*/
		pCCB = container_of(arcmsr_cdb, struct CommandControlBlock, arcmsr_cdb);
2540
		poll_ccb_done |= (pCCB == poll_ccb) ? 1 : 0;
2541 2542 2543 2544 2545
		/* check ifcommand done with no error*/
		if ((pCCB->acb != acb) || (pCCB->startdone != ARCMSR_CCB_START)) {
			if (pCCB->startdone == ARCMSR_CCB_ABORTED) {
				printk(KERN_NOTICE "arcmsr%d: scsi id = %d lun = %d ccb = '0x%p'"
					" poll command abort successfully \n"
2546
					, acb->host->host_no
2547
					, pCCB->pcmd->device->id
H
Hannes Reinecke 已提交
2548
					, (u32)pCCB->pcmd->device->lun
2549 2550 2551
					, pCCB);
					pCCB->pcmd->result = DID_ABORT << 16;
					arcmsr_ccb_complete(pCCB);
2552
				continue;
2553 2554 2555 2556 2557 2558 2559 2560
			}
			printk(KERN_NOTICE "arcmsr%d: polling get an illegal ccb"
				" command done ccb = '0x%p'"
				"ccboutstandingcount = %d \n"
				, acb->host->host_no
				, pCCB
				, atomic_read(&acb->ccboutstandingcount));
			continue;
2561
		}
2562 2563 2564
		error = (flag_ccb & ARCMSR_CCBREPLY_FLAG_ERROR_MODE1) ? true : false;
		arcmsr_report_ccb_state(acb, pCCB, error);
	}
2565
	return rtn;
2566
}
2567
static int arcmsr_polling_ccbdone(struct AdapterControlBlock *acb,
2568 2569
					struct CommandControlBlock *poll_ccb)
{
2570
	int rtn = 0;
2571 2572 2573
	switch (acb->adapter_type) {

	case ACB_ADAPTER_TYPE_A: {
2574
		rtn = arcmsr_hbaA_polling_ccbdone(acb, poll_ccb);
2575 2576 2577 2578
		}
		break;

	case ACB_ADAPTER_TYPE_B: {
2579
		rtn = arcmsr_hbaB_polling_ccbdone(acb, poll_ccb);
2580
		}
2581 2582
		break;
	case ACB_ADAPTER_TYPE_C: {
2583
		rtn = arcmsr_hbaC_polling_ccbdone(acb, poll_ccb);
2584
		}
2585
	}
2586
	return rtn;
2587
}
2588 2589

static int arcmsr_iop_confirm(struct AdapterControlBlock *acb)
2590
{
2591
	uint32_t cdb_phyaddr, cdb_phyaddr_hi32;
2592

2593 2594 2595 2596 2597 2598
	/*
	********************************************************************
	** here we need to tell iop 331 our freeccb.HighPart
	** if freeccb.HighPart is not zero
	********************************************************************
	*/
2599 2600
	cdb_phyaddr = lower_32_bits(acb->dma_coherent_handle);
	cdb_phyaddr_hi32 = upper_32_bits(acb->dma_coherent_handle);
2601
	acb->cdb_phyaddr_hi32 = cdb_phyaddr_hi32;
2602 2603 2604 2605 2606 2607 2608 2609
	/*
	***********************************************************************
	**    if adapter type B, set window of "post command Q"
	***********************************************************************
	*/
	switch (acb->adapter_type) {

	case ACB_ADAPTER_TYPE_A: {
2610
		if (cdb_phyaddr_hi32 != 0) {
A
Al Viro 已提交
2611
			struct MessageUnit_A __iomem *reg = acb->pmuA;
2612 2613
			writel(ARCMSR_SIGNATURE_SET_CONFIG, \
						&reg->message_rwbuffer[0]);
2614
			writel(cdb_phyaddr_hi32, &reg->message_rwbuffer[1]);
2615 2616
			writel(ARCMSR_INBOUND_MESG0_SET_CONFIG, \
							&reg->inbound_msgaddr0);
2617
			if (!arcmsr_hbaA_wait_msgint_ready(acb)) {
2618 2619 2620 2621
				printk(KERN_NOTICE "arcmsr%d: ""set ccb high \
				part physical address timeout\n",
				acb->host->host_no);
				return 1;
2622
			}
2623 2624 2625
		}
		}
		break;
2626

2627 2628
	case ACB_ADAPTER_TYPE_B: {
		unsigned long post_queue_phyaddr;
A
Al Viro 已提交
2629
		uint32_t __iomem *rwbuffer;
2630

A
Al Viro 已提交
2631
		struct MessageUnit_B *reg = acb->pmuB;
2632 2633
		reg->postq_index = 0;
		reg->doneq_index = 0;
2634
		writel(ARCMSR_MESSAGE_SET_POST_WINDOW, reg->drv2iop_doorbell);
2635
		if (!arcmsr_hbaB_wait_msgint_ready(acb)) {
2636 2637 2638 2639
			printk(KERN_NOTICE "arcmsr%d:can not set diver mode\n", \
				acb->host->host_no);
			return 1;
		}
2640
		post_queue_phyaddr = acb->dma_coherent_handle2;
2641
		rwbuffer = reg->message_rwbuffer;
2642 2643 2644
		/* driver "set config" signature */
		writel(ARCMSR_SIGNATURE_SET_CONFIG, rwbuffer++);
		/* normal should be zero */
2645
		writel(cdb_phyaddr_hi32, rwbuffer++);
2646 2647 2648 2649 2650 2651 2652
		/* postQ size (256 + 8)*4	 */
		writel(post_queue_phyaddr, rwbuffer++);
		/* doneQ size (256 + 8)*4	 */
		writel(post_queue_phyaddr + 1056, rwbuffer++);
		/* ccb maxQ size must be --> [(256 + 8)*4]*/
		writel(1056, rwbuffer);

2653
		writel(ARCMSR_MESSAGE_SET_CONFIG, reg->drv2iop_doorbell);
2654
		if (!arcmsr_hbaB_wait_msgint_ready(acb)) {
2655 2656 2657 2658
			printk(KERN_NOTICE "arcmsr%d: 'set command Q window' \
			timeout \n",acb->host->host_no);
			return 1;
		}
2659
		writel(ARCMSR_MESSAGE_START_DRIVER_MODE, reg->drv2iop_doorbell);
2660
		if (!arcmsr_hbaB_wait_msgint_ready(acb)) {
2661 2662 2663 2664
			pr_err("arcmsr%d: can't set driver mode.\n",
				acb->host->host_no);
			return 1;
		}
2665 2666
		}
		break;
2667 2668 2669 2670
	case ACB_ADAPTER_TYPE_C: {
		if (cdb_phyaddr_hi32 != 0) {
			struct MessageUnit_C *reg = (struct MessageUnit_C *)acb->pmuC;

2671 2672
			printk(KERN_NOTICE "arcmsr%d: cdb_phyaddr_hi32=0x%x\n",
					acb->adapter_index, cdb_phyaddr_hi32);
2673 2674 2675 2676
			writel(ARCMSR_SIGNATURE_SET_CONFIG, &reg->msgcode_rwbuffer[0]);
			writel(cdb_phyaddr_hi32, &reg->msgcode_rwbuffer[1]);
			writel(ARCMSR_INBOUND_MESG0_SET_CONFIG, &reg->inbound_msgaddr0);
			writel(ARCMSR_HBCMU_DRV2IOP_MESSAGE_CMD_DONE, &reg->inbound_doorbell);
2677
			if (!arcmsr_hbaC_wait_msgint_ready(acb)) {
2678 2679 2680 2681 2682 2683
				printk(KERN_NOTICE "arcmsr%d: 'set command Q window' \
				timeout \n", acb->host->host_no);
				return 1;
			}
		}
		}
2684 2685 2686
	}
	return 0;
}
2687

2688 2689 2690 2691 2692 2693
static void arcmsr_wait_firmware_ready(struct AdapterControlBlock *acb)
{
	uint32_t firmware_state = 0;
	switch (acb->adapter_type) {

	case ACB_ADAPTER_TYPE_A: {
A
Al Viro 已提交
2694
		struct MessageUnit_A __iomem *reg = acb->pmuA;
2695 2696 2697 2698 2699 2700 2701
		do {
			firmware_state = readl(&reg->outbound_msgaddr1);
		} while ((firmware_state & ARCMSR_OUTBOUND_MESG1_FIRMWARE_OK) == 0);
		}
		break;

	case ACB_ADAPTER_TYPE_B: {
A
Al Viro 已提交
2702
		struct MessageUnit_B *reg = acb->pmuB;
2703
		do {
2704
			firmware_state = readl(reg->iop2drv_doorbell);
2705
		} while ((firmware_state & ARCMSR_MESSAGE_FIRMWARE_OK) == 0);
2706
		writel(ARCMSR_DRV2IOP_END_OF_INTERRUPT, reg->drv2iop_doorbell);
2707 2708
		}
		break;
2709 2710 2711 2712 2713 2714
	case ACB_ADAPTER_TYPE_C: {
		struct MessageUnit_C *reg = (struct MessageUnit_C *)acb->pmuC;
		do {
			firmware_state = readl(&reg->outbound_msgaddr1);
		} while ((firmware_state & ARCMSR_HBCMU_MESSAGE_FIRMWARE_OK) == 0);
		}
2715
	}
2716 2717
}

2718
static void arcmsr_hbaA_request_device_map(struct AdapterControlBlock *acb)
2719 2720
{
	struct MessageUnit_A __iomem *reg = acb->pmuA;
2721
	if (unlikely(atomic_read(&acb->rq_map_token) == 0) || ((acb->acb_flags & ACB_F_BUS_RESET) != 0 ) || ((acb->acb_flags & ACB_F_ABORT) != 0 )){
2722
		mod_timer(&acb->eternal_timer, jiffies + msecs_to_jiffies(6 * HZ));
2723
		return;
2724
	} else {
2725
		acb->fw_flag = FW_NORMAL;
2726
		if (atomic_read(&acb->ante_token_value) == atomic_read(&acb->rq_map_token)){
2727 2728
			atomic_set(&acb->rq_map_token, 16);
		}
2729
		atomic_set(&acb->ante_token_value, atomic_read(&acb->rq_map_token));
2730 2731
		if (atomic_dec_and_test(&acb->rq_map_token)) {
			mod_timer(&acb->eternal_timer, jiffies + msecs_to_jiffies(6 * HZ));
2732
			return;
2733
		}
2734
		writel(ARCMSR_INBOUND_MESG0_GET_CONFIG, &reg->inbound_msgaddr0);
2735
		mod_timer(&acb->eternal_timer, jiffies + msecs_to_jiffies(6 * HZ));
2736 2737 2738 2739
	}
	return;
}

2740
static void arcmsr_hbaB_request_device_map(struct AdapterControlBlock *acb)
2741 2742
{
	struct MessageUnit_B __iomem *reg = acb->pmuB;
2743
	if (unlikely(atomic_read(&acb->rq_map_token) == 0) || ((acb->acb_flags & ACB_F_BUS_RESET) != 0 ) || ((acb->acb_flags & ACB_F_ABORT) != 0 )){
2744
		mod_timer(&acb->eternal_timer, jiffies + msecs_to_jiffies(6 * HZ));
2745 2746 2747 2748
		return;
	} else {
		acb->fw_flag = FW_NORMAL;
		if (atomic_read(&acb->ante_token_value) == atomic_read(&acb->rq_map_token)) {
2749
			atomic_set(&acb->rq_map_token, 16);
2750 2751
		}
		atomic_set(&acb->ante_token_value, atomic_read(&acb->rq_map_token));
2752 2753
		if (atomic_dec_and_test(&acb->rq_map_token)) {
			mod_timer(&acb->eternal_timer, jiffies + msecs_to_jiffies(6 * HZ));
2754
			return;
2755
		}
2756 2757 2758 2759 2760
		writel(ARCMSR_MESSAGE_GET_CONFIG, reg->drv2iop_doorbell);
		mod_timer(&acb->eternal_timer, jiffies + msecs_to_jiffies(6 * HZ));
	}
	return;
}
2761

2762
static void arcmsr_hbaC_request_device_map(struct AdapterControlBlock *acb)
2763 2764
{
	struct MessageUnit_C __iomem *reg = acb->pmuC;
2765
	if (unlikely(atomic_read(&acb->rq_map_token) == 0) || ((acb->acb_flags & ACB_F_BUS_RESET) != 0) || ((acb->acb_flags & ACB_F_ABORT) != 0)) {
2766
		mod_timer(&acb->eternal_timer, jiffies + msecs_to_jiffies(6 * HZ));
2767
		return;
2768
	} else {
2769 2770
		acb->fw_flag = FW_NORMAL;
		if (atomic_read(&acb->ante_token_value) == atomic_read(&acb->rq_map_token)) {
2771 2772
			atomic_set(&acb->rq_map_token, 16);
		}
2773
		atomic_set(&acb->ante_token_value, atomic_read(&acb->rq_map_token));
2774 2775
		if (atomic_dec_and_test(&acb->rq_map_token)) {
			mod_timer(&acb->eternal_timer, jiffies + msecs_to_jiffies(6 * HZ));
2776
			return;
2777
		}
2778 2779 2780
		writel(ARCMSR_INBOUND_MESG0_GET_CONFIG, &reg->inbound_msgaddr0);
		writel(ARCMSR_HBCMU_DRV2IOP_MESSAGE_CMD_DONE, &reg->inbound_doorbell);
		mod_timer(&acb->eternal_timer, jiffies + msecs_to_jiffies(6 * HZ));
2781 2782 2783 2784 2785 2786 2787 2788 2789
	}
	return;
}

static void arcmsr_request_device_map(unsigned long pacb)
{
	struct AdapterControlBlock *acb = (struct AdapterControlBlock *)pacb;
	switch (acb->adapter_type) {
		case ACB_ADAPTER_TYPE_A: {
2790
			arcmsr_hbaA_request_device_map(acb);
2791 2792 2793
		}
		break;
		case ACB_ADAPTER_TYPE_B: {
2794
			arcmsr_hbaB_request_device_map(acb);
2795 2796
		}
		break;
2797
		case ACB_ADAPTER_TYPE_C: {
2798
			arcmsr_hbaC_request_device_map(acb);
2799
		}
2800 2801 2802
	}
}

2803
static void arcmsr_hbaA_start_bgrb(struct AdapterControlBlock *acb)
2804
{
A
Al Viro 已提交
2805
	struct MessageUnit_A __iomem *reg = acb->pmuA;
2806 2807
	acb->acb_flags |= ACB_F_MSG_START_BGRB;
	writel(ARCMSR_INBOUND_MESG0_START_BGRB, &reg->inbound_msgaddr0);
2808
	if (!arcmsr_hbaA_wait_msgint_ready(acb)) {
2809 2810
		printk(KERN_NOTICE "arcmsr%d: wait 'start adapter background \
				rebulid' timeout \n", acb->host->host_no);
2811 2812 2813
	}
}

2814
static void arcmsr_hbaB_start_bgrb(struct AdapterControlBlock *acb)
2815
{
A
Al Viro 已提交
2816
	struct MessageUnit_B *reg = acb->pmuB;
2817
	acb->acb_flags |= ACB_F_MSG_START_BGRB;
2818
	writel(ARCMSR_MESSAGE_START_BGRB, reg->drv2iop_doorbell);
2819
	if (!arcmsr_hbaB_wait_msgint_ready(acb)) {
2820 2821 2822 2823
		printk(KERN_NOTICE "arcmsr%d: wait 'start adapter background \
				rebulid' timeout \n",acb->host->host_no);
	}
}
2824

2825
static void arcmsr_hbaC_start_bgrb(struct AdapterControlBlock *pACB)
2826 2827 2828 2829 2830
{
	struct MessageUnit_C *phbcmu = (struct MessageUnit_C *)pACB->pmuC;
	pACB->acb_flags |= ACB_F_MSG_START_BGRB;
	writel(ARCMSR_INBOUND_MESG0_START_BGRB, &phbcmu->inbound_msgaddr0);
	writel(ARCMSR_HBCMU_DRV2IOP_MESSAGE_CMD_DONE, &phbcmu->inbound_doorbell);
2831
	if (!arcmsr_hbaC_wait_msgint_ready(pACB)) {
2832 2833 2834 2835 2836
		printk(KERN_NOTICE "arcmsr%d: wait 'start adapter background \
				rebulid' timeout \n", pACB->host->host_no);
	}
	return;
}
2837
static void arcmsr_start_adapter_bgrb(struct AdapterControlBlock *acb)
2838
{
2839 2840
	switch (acb->adapter_type) {
	case ACB_ADAPTER_TYPE_A:
2841
		arcmsr_hbaA_start_bgrb(acb);
2842 2843
		break;
	case ACB_ADAPTER_TYPE_B:
2844
		arcmsr_hbaB_start_bgrb(acb);
2845
		break;
2846
	case ACB_ADAPTER_TYPE_C:
2847
		arcmsr_hbaC_start_bgrb(acb);
2848 2849
	}
}
2850

2851 2852 2853 2854
static void arcmsr_clear_doorbell_queue_buffer(struct AdapterControlBlock *acb)
{
	switch (acb->adapter_type) {
	case ACB_ADAPTER_TYPE_A: {
A
Al Viro 已提交
2855
		struct MessageUnit_A __iomem *reg = acb->pmuA;
2856 2857 2858 2859 2860 2861 2862 2863
		uint32_t outbound_doorbell;
		/* empty doorbell Qbuffer if door bell ringed */
		outbound_doorbell = readl(&reg->outbound_doorbell);
		/*clear doorbell interrupt */
		writel(outbound_doorbell, &reg->outbound_doorbell);
		writel(ARCMSR_INBOUND_DRIVER_DATA_READ_OK, &reg->inbound_doorbell);
		}
		break;
2864

2865
	case ACB_ADAPTER_TYPE_B: {
A
Al Viro 已提交
2866
		struct MessageUnit_B *reg = acb->pmuB;
2867
		/*clear interrupt and message state*/
2868 2869
		writel(ARCMSR_MESSAGE_INT_CLEAR_PATTERN, reg->iop2drv_doorbell);
		writel(ARCMSR_DRV2IOP_DATA_READ_OK, reg->drv2iop_doorbell);
2870 2871 2872
		/* let IOP know data has been read */
		}
		break;
2873 2874
	case ACB_ADAPTER_TYPE_C: {
		struct MessageUnit_C *reg = (struct MessageUnit_C *)acb->pmuC;
2875
		uint32_t outbound_doorbell, i;
2876 2877 2878 2879
		/* empty doorbell Qbuffer if door bell ringed */
		outbound_doorbell = readl(&reg->outbound_doorbell);
		writel(outbound_doorbell, &reg->outbound_doorbell_clear);
		writel(ARCMSR_HBCMU_DRV2IOP_DATA_READ_OK, &reg->inbound_doorbell);
2880 2881 2882 2883 2884 2885 2886 2887 2888 2889 2890 2891
		for (i = 0; i < 200; i++) {
			msleep(20);
			outbound_doorbell = readl(&reg->outbound_doorbell);
			if (outbound_doorbell &
				ARCMSR_HBCMU_IOP2DRV_DATA_WRITE_OK) {
				writel(outbound_doorbell,
					&reg->outbound_doorbell_clear);
				writel(ARCMSR_HBCMU_DRV2IOP_DATA_READ_OK,
					&reg->inbound_doorbell);
			} else
				break;
		}
2892
		}
2893
	}
2894
}
2895

N
Nick Cheng 已提交
2896 2897 2898 2899 2900 2901 2902 2903
static void arcmsr_enable_eoi_mode(struct AdapterControlBlock *acb)
{
	switch (acb->adapter_type) {
	case ACB_ADAPTER_TYPE_A:
		return;
	case ACB_ADAPTER_TYPE_B:
		{
			struct MessageUnit_B *reg = acb->pmuB;
2904
			writel(ARCMSR_MESSAGE_ACTIVE_EOI_MODE, reg->drv2iop_doorbell);
2905
			if (!arcmsr_hbaB_wait_msgint_ready(acb)) {
N
Nick Cheng 已提交
2906 2907 2908 2909 2910
				printk(KERN_NOTICE "ARCMSR IOP enables EOI_MODE TIMEOUT");
				return;
			}
		}
		break;
2911 2912
	case ACB_ADAPTER_TYPE_C:
		return;
N
Nick Cheng 已提交
2913 2914 2915 2916
	}
	return;
}

2917 2918 2919
static void arcmsr_hardware_reset(struct AdapterControlBlock *acb)
{
	uint8_t value[64];
2920 2921 2922
	int i, count = 0;
	struct MessageUnit_A __iomem *pmuA = acb->pmuA;
	struct MessageUnit_C __iomem *pmuC = acb->pmuC;
2923

2924
	/* backup pci config data */
2925
	printk(KERN_NOTICE "arcmsr%d: executing hw bus reset .....\n", acb->host->host_no);
2926 2927 2928 2929
	for (i = 0; i < 64; i++) {
		pci_read_config_byte(acb->pdev, i, &value[i]);
	}
	/* hardware reset signal */
2930
	if ((acb->dev_id == 0x1680)) {
2931 2932 2933 2934 2935 2936 2937 2938 2939 2940
		writel(ARCMSR_ARC1680_BUS_RESET, &pmuA->reserved1[0]);
	} else if ((acb->dev_id == 0x1880)) {
		do {
			count++;
			writel(0xF, &pmuC->write_sequence);
			writel(0x4, &pmuC->write_sequence);
			writel(0xB, &pmuC->write_sequence);
			writel(0x2, &pmuC->write_sequence);
			writel(0x7, &pmuC->write_sequence);
			writel(0xD, &pmuC->write_sequence);
2941
		} while (((readl(&pmuC->host_diagnostic) & ARCMSR_ARC1880_DiagWrite_ENABLE) == 0) && (count < 5));
2942
		writel(ARCMSR_ARC1880_RESET_ADAPTER, &pmuC->host_diagnostic);
2943
	} else {
2944
		pci_write_config_byte(acb->pdev, 0x84, 0x20);
2945
	}
2946
	msleep(2000);
2947 2948 2949 2950 2951 2952 2953
	/* write back pci config data */
	for (i = 0; i < 64; i++) {
		pci_write_config_byte(acb->pdev, i, value[i]);
	}
	msleep(1000);
	return;
}
2954 2955 2956
static void arcmsr_iop_init(struct AdapterControlBlock *acb)
{
	uint32_t intmask_org;
2957 2958
	/* disable all outbound interrupt */
	intmask_org = arcmsr_disable_outbound_ints(acb);
N
Nick Cheng 已提交
2959 2960
	arcmsr_wait_firmware_ready(acb);
	arcmsr_iop_confirm(acb);
2961 2962 2963 2964
	/*start background rebuild*/
	arcmsr_start_adapter_bgrb(acb);
	/* empty doorbell Qbuffer if door bell ringed */
	arcmsr_clear_doorbell_queue_buffer(acb);
N
Nick Cheng 已提交
2965
	arcmsr_enable_eoi_mode(acb);
2966 2967
	/* enable outbound Post Queue,outbound doorbell Interrupt */
	arcmsr_enable_outbound_ints(acb, intmask_org);
2968 2969 2970
	acb->acb_flags |= ACB_F_IOP_INITED;
}

2971
static uint8_t arcmsr_iop_reset(struct AdapterControlBlock *acb)
2972 2973 2974
{
	struct CommandControlBlock *ccb;
	uint32_t intmask_org;
2975
	uint8_t rtnval = 0x00;
2976
	int i = 0;
2977 2978
	unsigned long flags;

2979
	if (atomic_read(&acb->ccboutstandingcount) != 0) {
2980 2981
		/* disable all outbound interrupt */
		intmask_org = arcmsr_disable_outbound_ints(acb);
2982
		/* talk to iop 331 outstanding command aborted */
2983
		rtnval = arcmsr_abort_allcmd(acb);
2984
		/* clear all outbound posted Q */
2985
		arcmsr_done4abort_postqueue(acb);
2986 2987
		for (i = 0; i < ARCMSR_MAX_FREECCB_NUM; i++) {
			ccb = acb->pccb_pool[i];
2988
			if (ccb->startdone == ARCMSR_CCB_START) {
2989 2990 2991 2992 2993 2994
				scsi_dma_unmap(ccb->pcmd);
				ccb->startdone = ARCMSR_CCB_DONE;
				ccb->ccb_flags = 0;
				spin_lock_irqsave(&acb->ccblist_lock, flags);
				list_add_tail(&ccb->list, &acb->ccb_free_list);
				spin_unlock_irqrestore(&acb->ccblist_lock, flags);
2995 2996
			}
		}
2997
		atomic_set(&acb->ccboutstandingcount, 0);
2998 2999
		/* enable all outbound interrupt */
		arcmsr_enable_outbound_ints(acb, intmask_org);
3000
		return rtnval;
3001
	}
3002
	return rtnval;
3003 3004 3005 3006
}

static int arcmsr_bus_reset(struct scsi_cmnd *cmd)
{
3007
	struct AdapterControlBlock *acb;
3008 3009 3010 3011
	uint32_t intmask_org, outbound_doorbell;
	int retry_count = 0;
	int rtn = FAILED;
	acb = (struct AdapterControlBlock *) cmd->device->host->hostdata;
3012
	printk(KERN_ERR "arcmsr: executing bus reset eh.....num_resets = %d, num_aborts = %d \n", acb->num_resets, acb->num_aborts);
3013 3014
	acb->num_resets++;

3015 3016 3017
	switch(acb->adapter_type){
		case ACB_ADAPTER_TYPE_A:{
			if (acb->acb_flags & ACB_F_BUS_RESET){
3018
				long timeout;
3019 3020
				printk(KERN_ERR "arcmsr: there is an  bus reset eh proceeding.......\n");
				timeout = wait_event_timeout(wait_q, (acb->acb_flags & ACB_F_BUS_RESET) == 0, 220*HZ);
3021 3022 3023 3024 3025
				if (timeout) {
					return SUCCESS;
				}
			}
			acb->acb_flags |= ACB_F_BUS_RESET;
3026
			if (!arcmsr_iop_reset(acb)) {
3027 3028
				struct MessageUnit_A __iomem *reg;
				reg = acb->pmuA;
3029 3030
				arcmsr_hardware_reset(acb);
				acb->acb_flags &= ~ACB_F_IOP_INITED;
3031
sleep_again:
3032
				ssleep(ARCMSR_SLEEPTIME);
3033
				if ((readl(&reg->outbound_msgaddr1) & ARCMSR_OUTBOUND_MESG1_FIRMWARE_OK) == 0) {
3034 3035
					printk(KERN_ERR "arcmsr%d: waiting for hw bus reset return, retry=%d\n", acb->host->host_no, retry_count);
					if (retry_count > ARCMSR_RETRYCOUNT) {
3036
						acb->fw_flag = FW_DEADLOCK;
3037
						printk(KERN_ERR "arcmsr%d: waiting for hw bus reset return, RETRY TERMINATED!!\n", acb->host->host_no);
3038
						return FAILED;
3039 3040 3041 3042 3043 3044 3045
					}
					retry_count++;
					goto sleep_again;
				}
				acb->acb_flags |= ACB_F_IOP_INITED;
				/* disable all outbound interrupt */
				intmask_org = arcmsr_disable_outbound_ints(acb);
3046
				arcmsr_get_firmware_spec(acb);
3047 3048 3049 3050 3051 3052 3053 3054
				arcmsr_start_adapter_bgrb(acb);
				/* clear Qbuffer if door bell ringed */
				outbound_doorbell = readl(&reg->outbound_doorbell);
				writel(outbound_doorbell, &reg->outbound_doorbell); /*clear interrupt */
   				writel(ARCMSR_INBOUND_DRIVER_DATA_READ_OK, &reg->inbound_doorbell);
				/* enable outbound Post Queue,outbound doorbell Interrupt */
				arcmsr_enable_outbound_ints(acb, intmask_org);
				atomic_set(&acb->rq_map_token, 16);
3055 3056
				atomic_set(&acb->ante_token_value, 16);
				acb->fw_flag = FW_NORMAL;
3057
				mod_timer(&acb->eternal_timer, jiffies + msecs_to_jiffies(6 * HZ));
3058 3059
				acb->acb_flags &= ~ACB_F_BUS_RESET;
				rtn = SUCCESS;
3060
				printk(KERN_ERR "arcmsr: scsi  bus reset eh returns with success\n");
3061 3062
			} else {
				acb->acb_flags &= ~ACB_F_BUS_RESET;
3063 3064 3065 3066
				atomic_set(&acb->rq_map_token, 16);
				atomic_set(&acb->ante_token_value, 16);
				acb->fw_flag = FW_NORMAL;
				mod_timer(&acb->eternal_timer, jiffies + msecs_to_jiffies(6*HZ));
3067
				rtn = SUCCESS;
3068
			}
3069
			break;
3070
		}
3071 3072
		case ACB_ADAPTER_TYPE_B:{
			acb->acb_flags |= ACB_F_BUS_RESET;
3073
			if (!arcmsr_iop_reset(acb)) {
3074 3075
				acb->acb_flags &= ~ACB_F_BUS_RESET;
				rtn = FAILED;
3076 3077
			} else {
				acb->acb_flags &= ~ACB_F_BUS_RESET;
3078 3079 3080 3081
				atomic_set(&acb->rq_map_token, 16);
				atomic_set(&acb->ante_token_value, 16);
				acb->fw_flag = FW_NORMAL;
				mod_timer(&acb->eternal_timer, jiffies + msecs_to_jiffies(6 * HZ));
3082
				rtn = SUCCESS;
3083 3084 3085 3086 3087 3088 3089 3090 3091 3092 3093 3094 3095 3096 3097 3098 3099 3100 3101
			}
			break;
		}
		case ACB_ADAPTER_TYPE_C:{
			if (acb->acb_flags & ACB_F_BUS_RESET) {
				long timeout;
				printk(KERN_ERR "arcmsr: there is an bus reset eh proceeding.......\n");
				timeout = wait_event_timeout(wait_q, (acb->acb_flags & ACB_F_BUS_RESET) == 0, 220*HZ);
				if (timeout) {
					return SUCCESS;
				}
			}
			acb->acb_flags |= ACB_F_BUS_RESET;
			if (!arcmsr_iop_reset(acb)) {
				struct MessageUnit_C __iomem *reg;
				reg = acb->pmuC;
				arcmsr_hardware_reset(acb);
				acb->acb_flags &= ~ACB_F_IOP_INITED;
sleep:
3102
				ssleep(ARCMSR_SLEEPTIME);
3103
				if ((readl(&reg->host_diagnostic) & 0x04) != 0) {
3104 3105
					printk(KERN_ERR "arcmsr%d: waiting for hw bus reset return, retry=%d\n", acb->host->host_no, retry_count);
					if (retry_count > ARCMSR_RETRYCOUNT) {
3106
						acb->fw_flag = FW_DEADLOCK;
3107
						printk(KERN_ERR "arcmsr%d: waiting for hw bus reset return, RETRY TERMINATED!!\n", acb->host->host_no);
3108 3109 3110 3111 3112 3113 3114 3115 3116 3117 3118
						return FAILED;
					}
					retry_count++;
					goto sleep;
				}
				acb->acb_flags |= ACB_F_IOP_INITED;
				/* disable all outbound interrupt */
				intmask_org = arcmsr_disable_outbound_ints(acb);
				arcmsr_get_firmware_spec(acb);
				arcmsr_start_adapter_bgrb(acb);
				/* clear Qbuffer if door bell ringed */
3119
				arcmsr_clear_doorbell_queue_buffer(acb);
3120 3121 3122 3123 3124
				/* enable outbound Post Queue,outbound doorbell Interrupt */
				arcmsr_enable_outbound_ints(acb, intmask_org);
				atomic_set(&acb->rq_map_token, 16);
				atomic_set(&acb->ante_token_value, 16);
				acb->fw_flag = FW_NORMAL;
3125
				mod_timer(&acb->eternal_timer, jiffies + msecs_to_jiffies(6 * HZ));
3126 3127 3128 3129 3130
				acb->acb_flags &= ~ACB_F_BUS_RESET;
				rtn = SUCCESS;
				printk(KERN_ERR "arcmsr: scsi bus reset eh returns with success\n");
			} else {
				acb->acb_flags &= ~ACB_F_BUS_RESET;
3131 3132 3133 3134
				atomic_set(&acb->rq_map_token, 16);
				atomic_set(&acb->ante_token_value, 16);
				acb->fw_flag = FW_NORMAL;
				mod_timer(&acb->eternal_timer, jiffies + msecs_to_jiffies(6*HZ));
3135 3136 3137
				rtn = SUCCESS;
			}
			break;
3138 3139 3140
		}
	}
	return rtn;
3141 3142
}

3143
static int arcmsr_abort_one_cmd(struct AdapterControlBlock *acb,
3144 3145
		struct CommandControlBlock *ccb)
{
3146 3147 3148
	int rtn;
	rtn = arcmsr_polling_ccbdone(acb, ccb);
	return rtn;
3149 3150 3151 3152 3153 3154 3155
}

static int arcmsr_abort(struct scsi_cmnd *cmd)
{
	struct AdapterControlBlock *acb =
		(struct AdapterControlBlock *)cmd->device->host->hostdata;
	int i = 0;
3156
	int rtn = FAILED;
3157 3158
	uint32_t intmask_org;

3159
	printk(KERN_NOTICE
3160
		"arcmsr%d: abort device command of scsi id = %d lun = %d\n",
H
Hannes Reinecke 已提交
3161
		acb->host->host_no, cmd->device->id, (u32)cmd->device->lun);
3162
	acb->acb_flags |= ACB_F_ABORT;
3163 3164 3165 3166 3167 3168 3169
	acb->num_aborts++;
	/*
	************************************************
	** the all interrupt service routine is locked
	** we need to handle it as soon as possible and exit
	************************************************
	*/
3170 3171
	if (!atomic_read(&acb->ccboutstandingcount)) {
		acb->acb_flags &= ~ACB_F_ABORT;
3172
		return rtn;
3173
	}
3174

3175
	intmask_org = arcmsr_disable_outbound_ints(acb);
3176 3177 3178
	for (i = 0; i < ARCMSR_MAX_FREECCB_NUM; i++) {
		struct CommandControlBlock *ccb = acb->pccb_pool[i];
		if (ccb->startdone == ARCMSR_CCB_START && ccb->pcmd == cmd) {
3179 3180
			ccb->startdone = ARCMSR_CCB_ABORTED;
			rtn = arcmsr_abort_one_cmd(acb, ccb);
3181 3182 3183
			break;
		}
	}
3184
	acb->acb_flags &= ~ACB_F_ABORT;
3185
	arcmsr_enable_outbound_ints(acb, intmask_org);
3186
	return rtn;
3187 3188 3189 3190 3191 3192 3193 3194 3195 3196 3197
}

static const char *arcmsr_info(struct Scsi_Host *host)
{
	struct AdapterControlBlock *acb =
		(struct AdapterControlBlock *) host->hostdata;
	static char buf[256];
	char *type;
	int raid6 = 1;
	switch (acb->pdev->device) {
	case PCI_DEVICE_ID_ARECA_1110:
3198 3199
	case PCI_DEVICE_ID_ARECA_1200:
	case PCI_DEVICE_ID_ARECA_1202:
3200 3201 3202 3203 3204 3205 3206
	case PCI_DEVICE_ID_ARECA_1210:
		raid6 = 0;
		/*FALLTHRU*/
	case PCI_DEVICE_ID_ARECA_1120:
	case PCI_DEVICE_ID_ARECA_1130:
	case PCI_DEVICE_ID_ARECA_1160:
	case PCI_DEVICE_ID_ARECA_1170:
3207
	case PCI_DEVICE_ID_ARECA_1201:
3208 3209 3210 3211 3212 3213 3214 3215 3216 3217 3218
	case PCI_DEVICE_ID_ARECA_1220:
	case PCI_DEVICE_ID_ARECA_1230:
	case PCI_DEVICE_ID_ARECA_1260:
	case PCI_DEVICE_ID_ARECA_1270:
	case PCI_DEVICE_ID_ARECA_1280:
		type = "SATA";
		break;
	case PCI_DEVICE_ID_ARECA_1380:
	case PCI_DEVICE_ID_ARECA_1381:
	case PCI_DEVICE_ID_ARECA_1680:
	case PCI_DEVICE_ID_ARECA_1681:
3219
	case PCI_DEVICE_ID_ARECA_1880:
3220 3221 3222 3223 3224 3225
		type = "SAS";
		break;
	default:
		type = "X-TYPE";
		break;
	}
3226
	sprintf(buf, "Areca %s Host Adapter RAID Controller%s\n %s",
3227 3228 3229 3230
			type, raid6 ? "( RAID6 capable)" : "",
			ARCMSR_DRIVER_VERSION);
	return buf;
}