arcmsr_hba.c 127.8 KB
Newer Older
1 2 3 4
/*
*******************************************************************************
**        O.S   : Linux
**   FILE NAME  : arcmsr_hba.c
5 6
**        BY    : Nick Cheng, C.L. Huang
**   Description: SCSI RAID Device Driver for Areca RAID Controller
7
*******************************************************************************
8
** Copyright (C) 2002 - 2014, Areca Technology Corporation All rights reserved
9 10
**
**     Web site: www.areca.com.tw
11
**       E-mail: support@areca.com.tw
12 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
**
** 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>
58
#include <linux/slab.h>
59
#include <linux/pci.h>
60
#include <linux/aer.h>
61 62 63 64 65 66 67 68 69 70 71
#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"
72 73
MODULE_AUTHOR("Nick Cheng, C.L. Huang <support@areca.com.tw>");
MODULE_DESCRIPTION("Areca ARC11xx/12xx/16xx/188x SAS/SATA RAID Controller Driver");
74 75
MODULE_LICENSE("Dual BSD/GPL");
MODULE_VERSION(ARCMSR_DRIVER_VERSION);
76 77 78 79

#define	ARCMSR_SLEEPTIME	10
#define	ARCMSR_RETRYCOUNT	12

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

122 123 124 125 126 127 128 129
	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,
130
	.name			= "Areca SAS/SATA RAID driver",
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
	{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},
166 167
	{PCI_DEVICE(PCI_VENDOR_ID_ARECA, PCI_DEVICE_ID_ARECA_1214),
		.driver_data = ACB_ADAPTER_TYPE_D},
168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187
	{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},
188 189 190
	{0, 0}, /* Terminating entry */
};
MODULE_DEVICE_TABLE(pci, arcmsr_device_id_table);
191

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

206
static void arcmsr_free_mu(struct AdapterControlBlock *acb)
207 208
{
	switch (acb->adapter_type) {
209 210
	case ACB_ADAPTER_TYPE_B:
	case ACB_ADAPTER_TYPE_D: {
211 212 213
		dma_free_coherent(&acb->pdev->dev, acb->roundup_ccbsize,
			acb->dma_coherent2, acb->dma_coherent_handle2);
		break;
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 266 267 268 269 270 271 272 273 274 275 276 277
	case ACB_ADAPTER_TYPE_D: {
		void __iomem *mem_base0;
		unsigned long addr, range, flags;

		addr = (unsigned long)pci_resource_start(pdev, 0);
		range = pci_resource_len(pdev, 0);
		flags = pci_resource_flags(pdev, 0);
		if (flags & IORESOURCE_CACHEABLE)
			mem_base0 = ioremap(addr, range);
		else
			mem_base0 = ioremap_nocache(addr, range);
		if (!mem_base0) {
			pr_notice("arcmsr%d: memory mapping region fail\n",
				acb->host->host_no);
			return false;
		}
		acb->mem_base0 = mem_base0;
		break;
		}
278 279 280 281 282 283 284
	}
	return true;
}

static void arcmsr_unmap_pciregion(struct AdapterControlBlock *acb)
{
	switch (acb->adapter_type) {
285 286 287 288 289 290 291 292 293 294 295 296 297
	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);
	}
298 299 300 301
	break;
	case ACB_ADAPTER_TYPE_D:
		iounmap(acb->mem_base0);
		break;
302 303 304
	}
}

305
static irqreturn_t arcmsr_do_interrupt(int irq, void *dev_id)
306 307
{
	irqreturn_t handle_state;
308
	struct AdapterControlBlock *acb = dev_id;
309 310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338 339 340 341

	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;
}

342
static uint8_t arcmsr_hbaA_wait_msgint_ready(struct AdapterControlBlock *acb)
343 344
{
	struct MessageUnit_A __iomem *reg = acb->pmuA;
345 346 347 348 349 350 351 352 353 354 355
	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 */
356

357
	return false;
358 359
}

360
static uint8_t arcmsr_hbaB_wait_msgint_ready(struct AdapterControlBlock *acb)
361
{
362
	struct MessageUnit_B *reg = acb->pmuB;
363 364 365 366 367 368 369 370 371 372 373 374 375
	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 */
376

377
	return false;
378 379
}

380
static uint8_t arcmsr_hbaC_wait_msgint_ready(struct AdapterControlBlock *pACB)
381
{
382
	struct MessageUnit_C __iomem *phbcmu = pACB->pmuC;
383 384 385 386 387 388 389 390 391 392 393 394
	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 */

395 396
	return false;
}
397

398 399 400 401 402 403 404 405 406 407 408 409 410 411 412 413 414
static bool arcmsr_hbaD_wait_msgint_ready(struct AdapterControlBlock *pACB)
{
	struct MessageUnit_D *reg = pACB->pmuD;
	int i;

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

415
static void arcmsr_hbaA_flush_cache(struct AdapterControlBlock *acb)
416 417 418 419 420
{
	struct MessageUnit_A __iomem *reg = acb->pmuA;
	int retry_count = 30;
	writel(ARCMSR_INBOUND_MESG0_FLUSH_CACHE, &reg->inbound_msgaddr0);
	do {
421
		if (arcmsr_hbaA_wait_msgint_ready(acb))
422 423 424 425 426 427 428 429 430
			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);
}

431
static void arcmsr_hbaB_flush_cache(struct AdapterControlBlock *acb)
432 433 434 435 436
{
	struct MessageUnit_B *reg = acb->pmuB;
	int retry_count = 30;
	writel(ARCMSR_MESSAGE_FLUSH_CACHE, reg->drv2iop_doorbell);
	do {
437
		if (arcmsr_hbaB_wait_msgint_ready(acb))
438 439 440 441 442 443 444 445 446
			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);
}

447
static void arcmsr_hbaC_flush_cache(struct AdapterControlBlock *pACB)
448
{
449
	struct MessageUnit_C __iomem *reg = pACB->pmuC;
450 451 452 453
	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 {
454
		if (arcmsr_hbaC_wait_msgint_ready(pACB)) {
455 456 457 458 459 460 461 462 463
			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;
}
464 465 466 467 468 469 470 471 472 473 474 475 476 477 478 479 480 481

static void arcmsr_hbaD_flush_cache(struct AdapterControlBlock *pACB)
{
	int retry_count = 15;
	struct MessageUnit_D *reg = pACB->pmuD;

	writel(ARCMSR_INBOUND_MESG0_FLUSH_CACHE, reg->inbound_msgaddr0);
	do {
		if (arcmsr_hbaD_wait_msgint_ready(pACB))
			break;

		retry_count--;
		pr_notice("arcmsr%d: wait 'flush adapter "
			"cache' timeout, retry count down = %d\n",
			pACB->host->host_no, retry_count);
	} while (retry_count != 0);
}

482 483
static void arcmsr_flush_adapter_cache(struct AdapterControlBlock *acb)
{
484
	switch (acb->adapter_type) {
485

486
	case ACB_ADAPTER_TYPE_A: {
487
		arcmsr_hbaA_flush_cache(acb);
488 489
		}
		break;
490

491
	case ACB_ADAPTER_TYPE_B: {
492
		arcmsr_hbaB_flush_cache(acb);
493
		}
494 495
		break;
	case ACB_ADAPTER_TYPE_C: {
496
		arcmsr_hbaC_flush_cache(acb);
497
		}
498 499 500 501
		break;
	case ACB_ADAPTER_TYPE_D:
		arcmsr_hbaD_flush_cache(acb);
		break;
502 503
	}
}
504

505 506
static int arcmsr_alloc_ccb_pool(struct AdapterControlBlock *acb)
{
507 508 509 510 511 512
	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;
513
	unsigned long roundup_ccbsize;
514 515 516
	unsigned long max_xfer_len;
	unsigned long max_sg_entrys;
	uint32_t  firm_config_version;
517

518 519 520 521 522 523 524 525 526
	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 */
527
		max_sg_entrys = (max_xfer_len/4096);
528 529 530 531
	}
	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);
532
	acb->uncache_size = roundup_ccbsize * ARCMSR_MAX_FREECCB_NUM;
533 534
	dma_coherent = dma_alloc_coherent(&pdev->dev, acb->uncache_size, &dma_coherent_handle, GFP_KERNEL);
	if(!dma_coherent){
535
		printk(KERN_NOTICE "arcmsr%d: dma_alloc_coherent got error\n", acb->host->host_no);
536 537 538 539 540 541 542 543 544
		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);
545 546 547 548 549 550 551 552 553 554
		switch (acb->adapter_type) {
		case ACB_ADAPTER_TYPE_A:
		case ACB_ADAPTER_TYPE_B:
			ccb_tmp->cdb_phyaddr = cdb_phyaddr >> 5;
			break;
		case ACB_ADAPTER_TYPE_C:
		case ACB_ADAPTER_TYPE_D:
			ccb_tmp->cdb_phyaddr = cdb_phyaddr;
			break;
		}
555 556 557 558 559 560
		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;
561
	}
562 563
	return 0;
}
564

565 566
static void arcmsr_message_isr_bh_fn(struct work_struct *work) 
{
567 568 569 570 571 572 573 574 575
	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;

576
	switch (acb->adapter_type) {
577 578
	case ACB_ADAPTER_TYPE_A: {
		struct MessageUnit_A __iomem *reg  = acb->pmuA;
579

580 581
		signature = (uint32_t __iomem *)(&reg->message_rwbuffer[0]);
		devicemap = (char __iomem *)(&reg->message_rwbuffer[21]);
582
		break;
583 584 585 586 587 588 589 590 591 592 593 594 595 596 597
	}
	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;
	}
598 599 600 601 602 603 604
	case ACB_ADAPTER_TYPE_D: {
		struct MessageUnit_D *reg  = acb->pmuD;

		signature = (uint32_t __iomem *)(&reg->msgcode_rwbuffer[0]);
		devicemap = (char __iomem *)(&reg->msgcode_rwbuffer[21]);
		break;
	}
605 606 607 608 609 610 611 612 613 614 615 616 617 618 619 620 621 622 623 624 625 626 627
	}
	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);
628 629
					}
				}
630 631
				temp >>= 1;
				diff >>= 1;
632 633
			}
		}
634 635
		devicemap++;
		acb_dev_map++;
636 637
	}
}
638

639 640 641 642 643 644 645 646 647 648 649 650 651 652 653 654 655 656 657 658 659 660 661 662 663 664 665 666 667 668 669 670 671 672 673 674 675 676 677 678 679 680 681 682 683 684 685 686 687 688
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;
}

689
static int arcmsr_probe(struct pci_dev *pdev, const struct pci_device_id *id)
690 691 692
{
	struct Scsi_Host *host;
	struct AdapterControlBlock *acb;
693
	uint8_t bus,dev_fun;
694 695
	int error;
	error = pci_enable_device(pdev);
696
	if(error){
697 698 699
		return -ENODEV;
	}
	host = scsi_host_alloc(&arcmsr_scsi_host_template, sizeof(struct AdapterControlBlock));
700 701
	if(!host){
    		goto pci_disable_dev;
702
	}
703
	error = pci_set_dma_mask(pdev, DMA_BIT_MASK(64));
704
	if(error){
705
		error = pci_set_dma_mask(pdev, DMA_BIT_MASK(32));
706
		if(error){
707 708 709
			printk(KERN_WARNING
			       "scsi%d: No suitable DMA mask available\n",
			       host->host_no);
710
			goto scsi_host_release;
711 712
		}
	}
713
	init_waitqueue_head(&wait_q);
714 715
	bus = pdev->bus->number;
	dev_fun = pdev->devfn;
716
	acb = (struct AdapterControlBlock *) host->hostdata;
717
	memset(acb,0,sizeof(struct AdapterControlBlock));
718
	acb->pdev = pdev;
719
	acb->host = host;
720
	host->max_lun = ARCMSR_MAX_TARGETLUN;
721 722
	host->max_id = ARCMSR_MAX_TARGETID;		/*16:8*/
	host->max_cmd_len = 16;	 			/*this is issue of 64bit LBA ,over 2T byte*/
723
	host->can_queue = ARCMSR_MAX_OUTSTANDING_CMD;
724
	host->cmd_per_lun = ARCMSR_MAX_CMD_PERLUN;	    
725 726
	host->this_id = ARCMSR_SCSI_INITIATOR_ID;
	host->unique_id = (bus << 8) | dev_fun;
727 728
	pci_set_drvdata(pdev, host);
	pci_set_master(pdev);
729
	error = pci_request_regions(pdev, "arcmsr");
730
	if(error){
731
		goto scsi_host_release;
732
	}
733 734
	spin_lock_init(&acb->eh_lock);
	spin_lock_init(&acb->ccblist_lock);
735 736
	spin_lock_init(&acb->postq_lock);
	spin_lock_init(&acb->doneq_lock);
737 738
	spin_lock_init(&acb->rqbuffer_lock);
	spin_lock_init(&acb->wqbuffer_lock);
739
	acb->acb_flags |= (ACB_F_MESSAGE_WQBUFFER_CLEARED |
740 741
			ACB_F_MESSAGE_RQBUFFER_CLEARED |
			ACB_F_MESSAGE_WQBUFFER_READED);
742 743
	acb->acb_flags &= ~ACB_F_SCSISTOPADAPTER;
	INIT_LIST_HEAD(&acb->ccb_free_list);
744
	acb->adapter_type = id->driver_data;
745
	error = arcmsr_remap_pciregion(acb);
746
	if(!error){
747 748 749
		goto pci_release_regs;
	}
	error = arcmsr_get_firmware_spec(acb);
750
	if(!error){
751 752
		goto unmap_pci_region;
	}
753
	error = arcmsr_alloc_ccb_pool(acb);
754
	if(error){
755 756
		goto free_hbb_mu;
	}
757
	error = scsi_add_host(host, &pdev->dev);
758
	if(error){
759
		goto free_ccb_pool;
760
	}
761
	if (arcmsr_request_irq(pdev, acb) == FAILED)
762
		goto scsi_host_remove;
763
	arcmsr_iop_init(acb);
764
	INIT_WORK(&acb->arcmsr_do_message_isr_bh, arcmsr_message_isr_bh_fn);
765
	atomic_set(&acb->rq_map_token, 16);
766 767
	atomic_set(&acb->ante_token_value, 16);
	acb->fw_flag = FW_NORMAL;
768
	init_timer(&acb->eternal_timer);
769
	acb->eternal_timer.expires = jiffies + msecs_to_jiffies(6 * HZ);
770 771 772
	acb->eternal_timer.data = (unsigned long) acb;
	acb->eternal_timer.function = &arcmsr_request_device_map;
	add_timer(&acb->eternal_timer);
773
	if(arcmsr_alloc_sysfs_attr(acb))
774
		goto out_free_sysfs;
775
	scsi_scan_host(host);
776
	return 0;
777
out_free_sysfs:
778 779
	del_timer_sync(&acb->eternal_timer);
	flush_work(&acb->arcmsr_do_message_isr_bh);
780 781
	arcmsr_stop_adapter_bgrb(acb);
	arcmsr_flush_adapter_cache(acb);
782 783 784 785
	arcmsr_free_irq(pdev, acb);
scsi_host_remove:
	scsi_remove_host(host);
free_ccb_pool:
786
	arcmsr_free_ccb_pool(acb);
787
free_hbb_mu:
788
	arcmsr_free_mu(acb);
789 790 791
unmap_pci_region:
	arcmsr_unmap_pciregion(acb);
pci_release_regs:
792
	pci_release_regions(pdev);
793
scsi_host_release:
794
	scsi_host_put(host);
795
pci_disable_dev:
796
	pci_disable_device(pdev);
797
	return -ENODEV;
798 799
}

800 801 802 803 804 805 806 807 808 809 810 811 812 813 814 815
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);
}

816 817 818 819 820 821 822 823 824 825 826 827 828 829 830 831 832 833 834 835 836 837 838 839 840 841 842 843 844 845 846 847 848 849 850 851 852 853 854 855 856 857 858 859 860 861 862 863 864 865 866 867 868 869 870 871 872 873 874 875 876 877 878 879 880 881 882 883 884 885
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;
}

886
static uint8_t arcmsr_hbaA_abort_allcmd(struct AdapterControlBlock *acb)
887
{
A
Al Viro 已提交
888
	struct MessageUnit_A __iomem *reg = acb->pmuA;
889
	writel(ARCMSR_INBOUND_MESG0_ABORT_CMD, &reg->inbound_msgaddr0);
890
	if (!arcmsr_hbaA_wait_msgint_ready(acb)) {
891
		printk(KERN_NOTICE
892
			"arcmsr%d: wait 'abort all outstanding command' timeout\n"
893
			, acb->host->host_no);
894
		return false;
895
	}
896
	return true;
897 898
}

899
static uint8_t arcmsr_hbaB_abort_allcmd(struct AdapterControlBlock *acb)
900
{
A
Al Viro 已提交
901
	struct MessageUnit_B *reg = acb->pmuB;
902

903
	writel(ARCMSR_MESSAGE_ABORT_CMD, reg->drv2iop_doorbell);
904
	if (!arcmsr_hbaB_wait_msgint_ready(acb)) {
905
		printk(KERN_NOTICE
906
			"arcmsr%d: wait 'abort all outstanding command' timeout\n"
907
			, acb->host->host_no);
908
		return false;
909
	}
910 911
	return true;
}
912
static uint8_t arcmsr_hbaC_abort_allcmd(struct AdapterControlBlock *pACB)
913
{
914
	struct MessageUnit_C __iomem *reg = pACB->pmuC;
915 916
	writel(ARCMSR_INBOUND_MESG0_ABORT_CMD, &reg->inbound_msgaddr0);
	writel(ARCMSR_HBCMU_DRV2IOP_MESSAGE_CMD_DONE, &reg->inbound_doorbell);
917
	if (!arcmsr_hbaC_wait_msgint_ready(pACB)) {
918
		printk(KERN_NOTICE
919
			"arcmsr%d: wait 'abort all outstanding command' timeout\n"
920 921 922 923
			, pACB->host->host_no);
		return false;
	}
	return true;
924
}
925 926 927 928 929 930 931 932 933 934 935 936 937 938

static uint8_t arcmsr_hbaD_abort_allcmd(struct AdapterControlBlock *pACB)
{
	struct MessageUnit_D *reg = pACB->pmuD;

	writel(ARCMSR_INBOUND_MESG0_ABORT_CMD, reg->inbound_msgaddr0);
	if (!arcmsr_hbaD_wait_msgint_ready(pACB)) {
		pr_notice("arcmsr%d: wait 'abort all outstanding "
			"command' timeout\n", pACB->host->host_no);
		return false;
	}
	return true;
}

939
static uint8_t arcmsr_abort_allcmd(struct AdapterControlBlock *acb)
940
{
941
	uint8_t rtnval = 0;
942 943
	switch (acb->adapter_type) {
	case ACB_ADAPTER_TYPE_A: {
944
		rtnval = arcmsr_hbaA_abort_allcmd(acb);
945 946 947 948
		}
		break;

	case ACB_ADAPTER_TYPE_B: {
949
		rtnval = arcmsr_hbaB_abort_allcmd(acb);
950
		}
951 952 953
		break;

	case ACB_ADAPTER_TYPE_C: {
954
		rtnval = arcmsr_hbaC_abort_allcmd(acb);
955
		}
956 957 958 959 960
		break;

	case ACB_ADAPTER_TYPE_D:
		rtnval = arcmsr_hbaD_abort_allcmd(acb);
		break;
961
	}
962
	return rtnval;
963 964
}

965 966 967 968
static void arcmsr_pci_unmap_dma(struct CommandControlBlock *ccb)
{
	struct scsi_cmnd *pcmd = ccb->pcmd;

969
	scsi_dma_unmap(pcmd);
970
}
971

972
static void arcmsr_ccb_complete(struct CommandControlBlock *ccb)
973 974 975
{
	struct AdapterControlBlock *acb = ccb->acb;
	struct scsi_cmnd *pcmd = ccb->pcmd;
976 977
	unsigned long flags;
	atomic_dec(&acb->ccboutstandingcount);
978 979
	arcmsr_pci_unmap_dma(ccb);
	ccb->startdone = ARCMSR_CCB_DONE;
980
	spin_lock_irqsave(&acb->ccblist_lock, flags);
981
	list_add_tail(&ccb->list, &acb->ccb_free_list);
982
	spin_unlock_irqrestore(&acb->ccblist_lock, flags);
983 984 985
	pcmd->scsi_done(pcmd);
}

986 987 988 989 990 991 992 993
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 =
994 995 996
			sizeof(struct SENSE_DATA) < SCSI_SENSE_BUFFERSIZE
			? sizeof(struct SENSE_DATA) : SCSI_SENSE_BUFFERSIZE;
		memset(sensebuffer, 0, SCSI_SENSE_BUFFERSIZE);
997 998 999 1000 1001 1002 1003 1004 1005
		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;
1006
	switch (acb->adapter_type) {	
1007
	case ACB_ADAPTER_TYPE_A : {
A
Al Viro 已提交
1008
		struct MessageUnit_A __iomem *reg = acb->pmuA;
1009
		orig_mask = readl(&reg->outbound_intmask);
1010 1011 1012 1013 1014
		writel(orig_mask|ARCMSR_MU_OUTBOUND_ALL_INTMASKENABLE, \
						&reg->outbound_intmask);
		}
		break;
	case ACB_ADAPTER_TYPE_B : {
A
Al Viro 已提交
1015
		struct MessageUnit_B *reg = acb->pmuB;
1016 1017
		orig_mask = readl(reg->iop2drv_doorbell_mask);
		writel(0, reg->iop2drv_doorbell_mask);
1018 1019
		}
		break;
1020
	case ACB_ADAPTER_TYPE_C:{
1021
		struct MessageUnit_C __iomem *reg = acb->pmuC;
1022 1023 1024 1025 1026
		/* 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;
1027 1028 1029 1030 1031 1032
	case ACB_ADAPTER_TYPE_D: {
		struct MessageUnit_D *reg = acb->pmuD;
		/* disable all outbound interrupt */
		writel(ARCMSR_ARC1214_ALL_INT_DISABLE, reg->pcief0_int_enable);
		}
		break;
1033 1034 1035 1036
	}
	return orig_mask;
}

1037 1038
static void arcmsr_report_ccb_state(struct AdapterControlBlock *acb, 
			struct CommandControlBlock *ccb, bool error)
1039 1040 1041 1042
{
	uint8_t id, lun;
	id = ccb->pcmd->device->id;
	lun = ccb->pcmd->device->lun;
1043
	if (!error) {
1044 1045
		if (acb->devstate[id][lun] == ARECA_RAID_GONE)
			acb->devstate[id][lun] = ARECA_RAID_GOOD;
1046 1047
		ccb->pcmd->result = DID_OK << 16;
		arcmsr_ccb_complete(ccb);
1048
	}else{
1049 1050 1051 1052
		switch (ccb->arcmsr_cdb.DeviceStatus) {
		case ARCMSR_DEV_SELECT_TIMEOUT: {
			acb->devstate[id][lun] = ARECA_RAID_GONE;
			ccb->pcmd->result = DID_NO_CONNECT << 16;
1053
			arcmsr_ccb_complete(ccb);
1054 1055 1056 1057 1058 1059 1060 1061
			}
			break;

		case ARCMSR_DEV_ABORTED:

		case ARCMSR_DEV_INIT_FAIL: {
			acb->devstate[id][lun] = ARECA_RAID_GONE;
			ccb->pcmd->result = DID_BAD_TARGET << 16;
1062
			arcmsr_ccb_complete(ccb);
1063 1064 1065 1066 1067 1068
			}
			break;

		case ARCMSR_DEV_CHECK_CONDITION: {
			acb->devstate[id][lun] = ARECA_RAID_GOOD;
			arcmsr_report_sense_info(ccb);
1069
			arcmsr_ccb_complete(ccb);
1070 1071 1072 1073
			}
			break;

		default:
1074 1075 1076 1077 1078 1079 1080 1081 1082 1083
			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);
1084 1085 1086 1087 1088
			break;
		}
	}
}

1089
static void arcmsr_drain_donequeue(struct AdapterControlBlock *acb, struct CommandControlBlock *pCCB, bool error)
1090
{
1091
	int id, lun;
1092 1093 1094
	if ((pCCB->acb != acb) || (pCCB->startdone != ARCMSR_CCB_START)) {
		if (pCCB->startdone == ARCMSR_CCB_ABORTED) {
			struct scsi_cmnd *abortcmd = pCCB->pcmd;
1095
			if (abortcmd) {
1096
				id = abortcmd->device->id;
1097
				lun = abortcmd->device->lun;				
1098
				abortcmd->result |= DID_ABORT << 16;
1099 1100 1101
				arcmsr_ccb_complete(pCCB);
				printk(KERN_NOTICE "arcmsr%d: pCCB ='0x%p' isr got aborted command \n",
				acb->host->host_no, pCCB);
1102
			}
1103
			return;
1104 1105 1106 1107 1108 1109 1110
		}
		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
1111 1112 1113
				, pCCB
				, pCCB->acb
				, pCCB->startdone
1114
				, atomic_read(&acb->ccboutstandingcount));
1115
		  return;
1116
	}
1117
	arcmsr_report_ccb_state(acb, pCCB, error);
1118 1119 1120 1121 1122 1123
}

static void arcmsr_done4abort_postqueue(struct AdapterControlBlock *acb)
{
	int i = 0;
	uint32_t flag_ccb;
1124 1125 1126
	struct ARCMSR_CDB *pARCMSR_CDB;
	bool error;
	struct CommandControlBlock *pCCB;
1127 1128 1129
	switch (acb->adapter_type) {

	case ACB_ADAPTER_TYPE_A: {
A
Al Viro 已提交
1130
		struct MessageUnit_A __iomem *reg = acb->pmuA;
1131
		uint32_t outbound_intstatus;
A
Al Viro 已提交
1132
		outbound_intstatus = readl(&reg->outbound_intstatus) &
1133 1134 1135
					acb->outbound_int_enable;
		/*clear and abort all outbound posted Q*/
		writel(outbound_intstatus, &reg->outbound_intstatus);/*clear interrupt*/
1136
		while(((flag_ccb = readl(&reg->outbound_queueport)) != 0xFFFFFFFF)
1137
				&& (i++ < ARCMSR_MAX_OUTSTANDING_CMD)) {
1138 1139 1140 1141
			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);
1142 1143 1144 1145 1146
		}
		}
		break;

	case ACB_ADAPTER_TYPE_B: {
A
Al Viro 已提交
1147
		struct MessageUnit_B *reg = acb->pmuB;
1148
		/*clear all outbound posted Q*/
1149
		writel(ARCMSR_DOORBELL_INT_CLEAR_PATTERN, reg->iop2drv_doorbell); /* clear doorbell interrupt */
1150
		for (i = 0; i < ARCMSR_MAX_HBB_POSTQUEUE; i++) {
1151 1152 1153
			flag_ccb = reg->done_qbuffer[i];
			if (flag_ccb != 0) {
				reg->done_qbuffer[i] = 0;
1154 1155 1156 1157
				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);
1158
			}
1159
			reg->post_qbuffer[i] = 0;
1160 1161 1162 1163 1164
		}
		reg->doneq_index = 0;
		reg->postq_index = 0;
		}
		break;
1165
	case ACB_ADAPTER_TYPE_C: {
1166
		struct MessageUnit_C __iomem *reg = acb->pmuC;
1167 1168 1169 1170 1171 1172 1173 1174 1175 1176 1177 1178 1179
		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);
		}
1180 1181 1182 1183 1184 1185 1186 1187 1188 1189 1190 1191 1192 1193 1194 1195 1196 1197 1198 1199 1200 1201 1202 1203 1204 1205 1206 1207 1208 1209 1210 1211 1212 1213 1214 1215 1216 1217 1218 1219 1220 1221 1222 1223 1224 1225 1226 1227 1228 1229 1230 1231 1232 1233 1234 1235
		}
		break;
	case ACB_ADAPTER_TYPE_D: {
		struct MessageUnit_D  *pmu = acb->pmuD;
		uint32_t ccb_cdb_phy, outbound_write_pointer;
		uint32_t doneq_index, index_stripped, addressLow, residual;
		bool error;
		struct CommandControlBlock *pCCB;

		outbound_write_pointer = pmu->done_qbuffer[0].addressLow + 1;
		doneq_index = pmu->doneq_index;
		residual = atomic_read(&acb->ccboutstandingcount);
		for (i = 0; i < residual; i++) {
			while ((doneq_index & 0xFFF) !=
				(outbound_write_pointer & 0xFFF)) {
				if (doneq_index & 0x4000) {
					index_stripped = doneq_index & 0xFFF;
					index_stripped += 1;
					index_stripped %=
						ARCMSR_MAX_ARC1214_DONEQUEUE;
					pmu->doneq_index = index_stripped ?
						(index_stripped | 0x4000) :
						(index_stripped + 1);
				} else {
					index_stripped = doneq_index;
					index_stripped += 1;
					index_stripped %=
						ARCMSR_MAX_ARC1214_DONEQUEUE;
					pmu->doneq_index = index_stripped ?
						index_stripped :
						((index_stripped | 0x4000) + 1);
				}
				doneq_index = pmu->doneq_index;
				addressLow = pmu->done_qbuffer[doneq_index &
					0xFFF].addressLow;
				ccb_cdb_phy = (addressLow & 0xFFFFFFF0);
				pARCMSR_CDB = (struct  ARCMSR_CDB *)
					(acb->vir2phy_offset + ccb_cdb_phy);
				pCCB = container_of(pARCMSR_CDB,
					struct CommandControlBlock, arcmsr_cdb);
				error = (addressLow &
					ARCMSR_CCBREPLY_FLAG_ERROR_MODE1) ?
					true : false;
				arcmsr_drain_donequeue(acb, pCCB, error);
				writel(doneq_index,
					pmu->outboundlist_read_pointer);
			}
			mdelay(10);
			outbound_write_pointer =
				pmu->done_qbuffer[0].addressLow + 1;
			doneq_index = pmu->doneq_index;
		}
		pmu->postq_index = 0;
		pmu->doneq_index = 0x40FF;
		}
		break;
1236 1237
	}
}
1238

1239 1240 1241 1242 1243 1244 1245 1246
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);
1247
	flush_work(&acb->arcmsr_do_message_isr_bh);
1248 1249
	del_timer_sync(&acb->eternal_timer);
	arcmsr_disable_outbound_ints(acb);
1250
	arcmsr_stop_adapter_bgrb(acb);
1251
	arcmsr_flush_adapter_cache(acb);	
1252 1253 1254
	acb->acb_flags |= ACB_F_SCSISTOPADAPTER;
	acb->acb_flags &= ~ACB_F_IOP_INITED;

1255
	for (poll_count = 0; poll_count < ARCMSR_MAX_OUTSTANDING_CMD; poll_count++){
1256 1257
		if (!atomic_read(&acb->ccboutstandingcount))
			break;
1258
		arcmsr_interrupt(acb);/* FIXME: need spinlock */
1259 1260 1261 1262 1263 1264 1265
		msleep(25);
	}

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

		arcmsr_abort_allcmd(acb);
1266
		arcmsr_done4abort_postqueue(acb);
1267 1268 1269 1270 1271
		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;
1272
				arcmsr_ccb_complete(ccb);
1273 1274 1275
			}
		}
	}
1276
	arcmsr_free_irq(pdev, acb);
1277
	arcmsr_free_ccb_pool(acb);
1278
	arcmsr_free_mu(acb);
1279
	arcmsr_unmap_pciregion(acb);
1280
	pci_release_regions(pdev);
1281
	scsi_host_put(host);
1282 1283 1284 1285 1286 1287 1288 1289
	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;
1290 1291
	del_timer_sync(&acb->eternal_timer);
	arcmsr_disable_outbound_ints(acb);
1292
	arcmsr_free_irq(pdev, acb);
1293
	flush_work(&acb->arcmsr_do_message_isr_bh);
1294 1295 1296 1297 1298 1299 1300 1301 1302 1303 1304 1305 1306 1307 1308 1309 1310 1311
	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);

1312
static void arcmsr_enable_outbound_ints(struct AdapterControlBlock *acb,
1313
						u32 intmask_org)
1314 1315
{
	u32 mask;
1316
	switch (acb->adapter_type) {
1317

1318
	case ACB_ADAPTER_TYPE_A: {
A
Al Viro 已提交
1319
		struct MessageUnit_A __iomem *reg = acb->pmuA;
1320
		mask = intmask_org & ~(ARCMSR_MU_OUTBOUND_POSTQUEUE_INTMASKENABLE |
1321 1322
			     ARCMSR_MU_OUTBOUND_DOORBELL_INTMASKENABLE|
			     ARCMSR_MU_OUTBOUND_MESSAGE0_INTMASKENABLE);
1323 1324 1325 1326
		writel(mask, &reg->outbound_intmask);
		acb->outbound_int_enable = ~(intmask_org & mask) & 0x000000ff;
		}
		break;
1327

1328
	case ACB_ADAPTER_TYPE_B: {
A
Al Viro 已提交
1329
		struct MessageUnit_B *reg = acb->pmuB;
1330 1331 1332 1333
		mask = intmask_org | (ARCMSR_IOP2DRV_DATA_WRITE_OK |
			ARCMSR_IOP2DRV_DATA_READ_OK |
			ARCMSR_IOP2DRV_CDB_DONE |
			ARCMSR_IOP2DRV_MESSAGE_CMD_DONE);
1334
		writel(mask, reg->iop2drv_doorbell_mask);
1335 1336
		acb->outbound_int_enable = (intmask_org | mask) & 0x0000000f;
		}
1337 1338
		break;
	case ACB_ADAPTER_TYPE_C: {
1339
		struct MessageUnit_C __iomem *reg = acb->pmuC;
1340 1341 1342 1343
		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;
		}
1344 1345 1346 1347 1348 1349 1350 1351
		break;
	case ACB_ADAPTER_TYPE_D: {
		struct MessageUnit_D *reg = acb->pmuD;

		mask = ARCMSR_ARC1214_ALL_INT_ENABLE;
		writel(intmask_org | mask, reg->pcief0_int_enable);
		break;
		}
1352 1353 1354
	}
}

N
Nick Cheng 已提交
1355
static int arcmsr_build_ccb(struct AdapterControlBlock *acb,
1356
	struct CommandControlBlock *ccb, struct scsi_cmnd *pcmd)
1357
{
1358 1359
	struct ARCMSR_CDB *arcmsr_cdb = (struct ARCMSR_CDB *)&ccb->arcmsr_cdb;
	int8_t *psge = (int8_t *)&arcmsr_cdb->u;
A
Al Viro 已提交
1360
	__le32 address_lo, address_hi;
1361
	int arccdbsize = 0x30;
1362
	__le32 length = 0;
1363
	int i;
1364
	struct scatterlist *sg;
1365
	int nseg;
1366
	ccb->pcmd = pcmd;
1367
	memset(arcmsr_cdb, 0, sizeof(struct ARCMSR_CDB));
1368 1369 1370
	arcmsr_cdb->TargetID = pcmd->device->id;
	arcmsr_cdb->LUN = pcmd->device->lun;
	arcmsr_cdb->Function = 1;
1371
	arcmsr_cdb->msgContext = 0;
1372
	memcpy(arcmsr_cdb->Cdb, pcmd->cmnd, pcmd->cmd_len);
1373 1374

	nseg = scsi_dma_map(pcmd);
1375
	if (unlikely(nseg > acb->host->sg_tablesize || nseg < 0))
N
Nick Cheng 已提交
1376
		return FAILED;
1377 1378 1379 1380 1381 1382 1383 1384 1385 1386 1387 1388 1389 1390
	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;
1391

1392 1393 1394 1395 1396
			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);
1397
		}
1398 1399 1400
	}
	arcmsr_cdb->sgcount = (uint8_t)nseg;
	arcmsr_cdb->DataLength = scsi_bufflen(pcmd);
1401
	arcmsr_cdb->msgPages = arccdbsize/0x100 + (arccdbsize % 0x100 ? 1 : 0);
1402 1403
	if ( arccdbsize > 256)
		arcmsr_cdb->Flags |= ARCMSR_CDB_FLAG_SGL_BSIZE;
1404
	if (pcmd->sc_data_direction == DMA_TO_DEVICE)
1405
		arcmsr_cdb->Flags |= ARCMSR_CDB_FLAG_WRITE;
1406
	ccb->arc_cdb_size = arccdbsize;
N
Nick Cheng 已提交
1407
	return SUCCESS;
1408 1409 1410 1411
}

static void arcmsr_post_ccb(struct AdapterControlBlock *acb, struct CommandControlBlock *ccb)
{
1412
	uint32_t cdb_phyaddr = ccb->cdb_phyaddr;
1413 1414 1415
	struct ARCMSR_CDB *arcmsr_cdb = (struct ARCMSR_CDB *)&ccb->arcmsr_cdb;
	atomic_inc(&acb->ccboutstandingcount);
	ccb->startdone = ARCMSR_CCB_START;
1416 1417
	switch (acb->adapter_type) {
	case ACB_ADAPTER_TYPE_A: {
A
Al Viro 已提交
1418
		struct MessageUnit_A __iomem *reg = acb->pmuA;
1419 1420

		if (arcmsr_cdb->Flags & ARCMSR_CDB_FLAG_SGL_BSIZE)
1421
			writel(cdb_phyaddr | ARCMSR_CCBPOST_FLAG_SGL_BSIZE,
1422
			&reg->inbound_queueport);
1423 1424
		else
			writel(cdb_phyaddr, &reg->inbound_queueport);
1425
		break;
1426
	}
1427

1428
	case ACB_ADAPTER_TYPE_B: {
A
Al Viro 已提交
1429
		struct MessageUnit_B *reg = acb->pmuB;
1430
		uint32_t ending_index, index = reg->postq_index;
1431

1432
		ending_index = ((index + 1) % ARCMSR_MAX_HBB_POSTQUEUE);
1433
		reg->post_qbuffer[ending_index] = 0;
1434
		if (arcmsr_cdb->Flags & ARCMSR_CDB_FLAG_SGL_BSIZE) {
1435 1436
			reg->post_qbuffer[index] =
				cdb_phyaddr | ARCMSR_CCBPOST_FLAG_SGL_BSIZE;
1437
		} else {
1438
			reg->post_qbuffer[index] = cdb_phyaddr;
1439 1440 1441 1442
		}
		index++;
		index %= ARCMSR_MAX_HBB_POSTQUEUE;/*if last index number set it to 0 */
		reg->postq_index = index;
1443
		writel(ARCMSR_DRV2IOP_CDB_POSTED, reg->drv2iop_doorbell);
1444
		}
1445
		break;
1446
	case ACB_ADAPTER_TYPE_C: {
1447
		struct MessageUnit_C __iomem *phbcmu = acb->pmuC;
1448 1449 1450
		uint32_t ccb_post_stamp, arc_cdb_size;

		arc_cdb_size = (ccb->arc_cdb_size > 0x300) ? 0x300 : ccb->arc_cdb_size;
1451
		ccb_post_stamp = (cdb_phyaddr | ((arc_cdb_size - 1) >> 6) | 1);
1452 1453 1454 1455 1456 1457 1458
		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);
		}
		}
1459 1460 1461 1462 1463 1464 1465 1466 1467 1468 1469 1470 1471 1472 1473 1474 1475 1476 1477 1478 1479 1480 1481 1482 1483 1484 1485 1486 1487 1488 1489 1490
		break;
	case ACB_ADAPTER_TYPE_D: {
		struct MessageUnit_D  *pmu = acb->pmuD;
		u16 index_stripped;
		u16 postq_index;
		unsigned long flags;
		struct InBound_SRB *pinbound_srb;

		spin_lock_irqsave(&acb->postq_lock, flags);
		postq_index = pmu->postq_index;
		pinbound_srb = (struct InBound_SRB *)&(pmu->post_qbuffer[postq_index & 0xFF]);
		pinbound_srb->addressHigh = dma_addr_hi32(cdb_phyaddr);
		pinbound_srb->addressLow = dma_addr_lo32(cdb_phyaddr);
		pinbound_srb->length = ccb->arc_cdb_size >> 2;
		arcmsr_cdb->msgContext = dma_addr_lo32(cdb_phyaddr);
		if (postq_index & 0x4000) {
			index_stripped = postq_index & 0xFF;
			index_stripped += 1;
			index_stripped %= ARCMSR_MAX_ARC1214_POSTQUEUE;
			pmu->postq_index = index_stripped ?
				(index_stripped | 0x4000) : index_stripped;
		} else {
			index_stripped = postq_index;
			index_stripped += 1;
			index_stripped %= ARCMSR_MAX_ARC1214_POSTQUEUE;
			pmu->postq_index = index_stripped ? index_stripped :
				(index_stripped | 0x4000);
		}
		writel(postq_index, pmu->inboundlist_write_pointer);
		spin_unlock_irqrestore(&acb->postq_lock, flags);
		break;
		}
1491 1492 1493
	}
}

1494
static void arcmsr_hbaA_stop_bgrb(struct AdapterControlBlock *acb)
1495
{
A
Al Viro 已提交
1496
	struct MessageUnit_A __iomem *reg = acb->pmuA;
1497 1498
	acb->acb_flags &= ~ACB_F_MSG_START_BGRB;
	writel(ARCMSR_INBOUND_MESG0_STOP_BGRB, &reg->inbound_msgaddr0);
1499
	if (!arcmsr_hbaA_wait_msgint_ready(acb)) {
1500
		printk(KERN_NOTICE
1501
			"arcmsr%d: wait 'stop adapter background rebulid' timeout\n"
1502 1503 1504 1505
			, acb->host->host_no);
	}
}

1506
static void arcmsr_hbaB_stop_bgrb(struct AdapterControlBlock *acb)
1507
{
A
Al Viro 已提交
1508
	struct MessageUnit_B *reg = acb->pmuB;
1509
	acb->acb_flags &= ~ACB_F_MSG_START_BGRB;
1510
	writel(ARCMSR_MESSAGE_STOP_BGRB, reg->drv2iop_doorbell);
1511

1512
	if (!arcmsr_hbaB_wait_msgint_ready(acb)) {
1513
		printk(KERN_NOTICE
1514
			"arcmsr%d: wait 'stop adapter background rebulid' timeout\n"
1515
			, acb->host->host_no);
1516 1517 1518
	}
}

1519
static void arcmsr_hbaC_stop_bgrb(struct AdapterControlBlock *pACB)
1520
{
1521
	struct MessageUnit_C __iomem *reg = pACB->pmuC;
1522 1523 1524
	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);
1525
	if (!arcmsr_hbaC_wait_msgint_ready(pACB)) {
1526
		printk(KERN_NOTICE
1527
			"arcmsr%d: wait 'stop adapter background rebulid' timeout\n"
1528 1529 1530 1531
			, pACB->host->host_no);
	}
	return;
}
1532 1533 1534 1535 1536 1537 1538 1539 1540 1541 1542 1543

static void arcmsr_hbaD_stop_bgrb(struct AdapterControlBlock *pACB)
{
	struct MessageUnit_D *reg = pACB->pmuD;

	pACB->acb_flags &= ~ACB_F_MSG_START_BGRB;
	writel(ARCMSR_INBOUND_MESG0_STOP_BGRB, reg->inbound_msgaddr0);
	if (!arcmsr_hbaD_wait_msgint_ready(pACB))
		pr_notice("arcmsr%d: wait 'stop adapter background rebulid' "
			"timeout\n", pACB->host->host_no);
}

1544 1545 1546 1547
static void arcmsr_stop_adapter_bgrb(struct AdapterControlBlock *acb)
{
	switch (acb->adapter_type) {
	case ACB_ADAPTER_TYPE_A: {
1548
		arcmsr_hbaA_stop_bgrb(acb);
1549 1550 1551 1552
		}
		break;

	case ACB_ADAPTER_TYPE_B: {
1553
		arcmsr_hbaB_stop_bgrb(acb);
1554 1555
		}
		break;
1556
	case ACB_ADAPTER_TYPE_C: {
1557
		arcmsr_hbaC_stop_bgrb(acb);
1558
		}
1559 1560 1561 1562
		break;
	case ACB_ADAPTER_TYPE_D:
		arcmsr_hbaD_stop_bgrb(acb);
		break;
1563
	}
1564 1565 1566 1567
}

static void arcmsr_free_ccb_pool(struct AdapterControlBlock *acb)
{
1568
	dma_free_coherent(&acb->pdev->dev, acb->uncache_size, acb->dma_coherent, acb->dma_coherent_handle);
1569 1570
}

1571
static void arcmsr_iop_message_read(struct AdapterControlBlock *acb)
1572
{
1573 1574
	switch (acb->adapter_type) {
	case ACB_ADAPTER_TYPE_A: {
A
Al Viro 已提交
1575
		struct MessageUnit_A __iomem *reg = acb->pmuA;
1576 1577 1578
		writel(ARCMSR_INBOUND_DRIVER_DATA_READ_OK, &reg->inbound_doorbell);
		}
		break;
1579

1580
	case ACB_ADAPTER_TYPE_B: {
A
Al Viro 已提交
1581
		struct MessageUnit_B *reg = acb->pmuB;
1582
		writel(ARCMSR_DRV2IOP_DATA_READ_OK, reg->drv2iop_doorbell);
1583
		}
1584
		break;
1585 1586
	case ACB_ADAPTER_TYPE_C: {
		struct MessageUnit_C __iomem *reg = acb->pmuC;
1587

1588 1589
		writel(ARCMSR_HBCMU_DRV2IOP_DATA_READ_OK, &reg->inbound_doorbell);
		}
1590 1591 1592 1593 1594 1595 1596
		break;
	case ACB_ADAPTER_TYPE_D: {
		struct MessageUnit_D *reg = acb->pmuD;
		writel(ARCMSR_ARC1214_DRV2IOP_DATA_OUT_READ,
			reg->inbound_doorbell);
		}
		break;
1597
	}
1598 1599 1600 1601 1602 1603
}

static void arcmsr_iop_message_wrote(struct AdapterControlBlock *acb)
{
	switch (acb->adapter_type) {
	case ACB_ADAPTER_TYPE_A: {
A
Al Viro 已提交
1604
		struct MessageUnit_A __iomem *reg = acb->pmuA;
1605
		/*
1606 1607
		** push inbound doorbell tell iop, driver data write ok
		** and wait reply on next hwinterrupt for next Qbuffer post
1608
		*/
1609 1610 1611 1612 1613
		writel(ARCMSR_INBOUND_DRIVER_DATA_WRITE_OK, &reg->inbound_doorbell);
		}
		break;

	case ACB_ADAPTER_TYPE_B: {
A
Al Viro 已提交
1614
		struct MessageUnit_B *reg = acb->pmuB;
1615 1616 1617 1618
		/*
		** push inbound doorbell tell iop, driver data write ok
		** and wait reply on next hwinterrupt for next Qbuffer post
		*/
1619
		writel(ARCMSR_DRV2IOP_DATA_WRITE_OK, reg->drv2iop_doorbell);
1620 1621
		}
		break;
1622 1623 1624 1625 1626 1627 1628 1629 1630
	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;
1631 1632 1633 1634 1635 1636
	case ACB_ADAPTER_TYPE_D: {
		struct MessageUnit_D *reg = acb->pmuD;
		writel(ARCMSR_ARC1214_DRV2IOP_DATA_IN_READY,
			reg->inbound_doorbell);
		}
		break;
1637 1638 1639
	}
}

A
Al Viro 已提交
1640
struct QBUFFER __iomem *arcmsr_get_iop_rqbuffer(struct AdapterControlBlock *acb)
1641
{
1642
	struct QBUFFER __iomem *qbuffer = NULL;
1643 1644 1645
	switch (acb->adapter_type) {

	case ACB_ADAPTER_TYPE_A: {
A
Al Viro 已提交
1646 1647
		struct MessageUnit_A __iomem *reg = acb->pmuA;
		qbuffer = (struct QBUFFER __iomem *)&reg->message_rbuffer;
1648 1649 1650 1651
		}
		break;

	case ACB_ADAPTER_TYPE_B: {
A
Al Viro 已提交
1652
		struct MessageUnit_B *reg = acb->pmuB;
1653
		qbuffer = (struct QBUFFER __iomem *)reg->message_rbuffer;
1654 1655
		}
		break;
1656
	case ACB_ADAPTER_TYPE_C: {
1657
		struct MessageUnit_C __iomem *phbcmu = acb->pmuC;
1658 1659
		qbuffer = (struct QBUFFER __iomem *)&phbcmu->message_rbuffer;
		}
1660 1661 1662 1663 1664 1665
		break;
	case ACB_ADAPTER_TYPE_D: {
		struct MessageUnit_D *reg = acb->pmuD;
		qbuffer = (struct QBUFFER __iomem *)reg->message_rbuffer;
		}
		break;
1666 1667 1668 1669
	}
	return qbuffer;
}

A
Al Viro 已提交
1670
static struct QBUFFER __iomem *arcmsr_get_iop_wqbuffer(struct AdapterControlBlock *acb)
1671
{
1672
	struct QBUFFER __iomem *pqbuffer = NULL;
1673 1674 1675
	switch (acb->adapter_type) {

	case ACB_ADAPTER_TYPE_A: {
A
Al Viro 已提交
1676 1677
		struct MessageUnit_A __iomem *reg = acb->pmuA;
		pqbuffer = (struct QBUFFER __iomem *) &reg->message_wbuffer;
1678 1679 1680 1681
		}
		break;

	case ACB_ADAPTER_TYPE_B: {
A
Al Viro 已提交
1682
		struct MessageUnit_B  *reg = acb->pmuB;
1683
		pqbuffer = (struct QBUFFER __iomem *)reg->message_wbuffer;
1684 1685
		}
		break;
1686
	case ACB_ADAPTER_TYPE_C: {
1687
		struct MessageUnit_C __iomem *reg = acb->pmuC;
1688
		pqbuffer = (struct QBUFFER __iomem *)&reg->message_wbuffer;
1689 1690 1691 1692 1693 1694 1695
		}
		break;
	case ACB_ADAPTER_TYPE_D: {
		struct MessageUnit_D *reg = acb->pmuD;
		pqbuffer = (struct QBUFFER __iomem *)reg->message_wbuffer;
		}
		break;
1696 1697 1698 1699
	}
	return pqbuffer;
}

1700 1701 1702
static uint32_t
arcmsr_Read_iop_rqbuffer_in_DWORD(struct AdapterControlBlock *acb,
		struct QBUFFER __iomem *prbuffer)
1703
{
1704 1705 1706 1707 1708 1709 1710 1711 1712 1713 1714 1715 1716 1717 1718
	uint8_t *pQbuffer;
	uint8_t *buf1 = NULL;
	uint32_t __iomem *iop_data;
	uint32_t iop_len, data_len, *buf2 = NULL;

	iop_data = (uint32_t __iomem *)prbuffer->data;
	iop_len = readl(&prbuffer->data_len);
	if (iop_len > 0) {
		buf1 = kmalloc(128, GFP_ATOMIC);
		buf2 = (uint32_t *)buf1;
		if (buf1 == NULL)
			return 0;
		data_len = iop_len;
		while (data_len >= 4) {
			*buf2++ = readl(iop_data);
1719
			iop_data++;
1720
			data_len -= 4;
1721
		}
1722 1723 1724 1725 1726 1727 1728 1729 1730 1731 1732 1733 1734 1735 1736 1737 1738 1739 1740 1741 1742 1743 1744 1745 1746 1747 1748 1749
		if (data_len)
			*buf2 = readl(iop_data);
		buf2 = (uint32_t *)buf1;
	}
	while (iop_len > 0) {
		pQbuffer = &acb->rqbuffer[acb->rqbuf_lastindex];
		*pQbuffer = *buf1;
		acb->rqbuf_lastindex++;
		/* if last, index number set it to 0 */
		acb->rqbuf_lastindex %= ARCMSR_MAX_QBUFFER;
		buf1++;
		iop_len--;
	}
	if (buf2)
		kfree(buf2);
	/* let IOP know data has been read */
	arcmsr_iop_message_read(acb);
	return 1;
}

uint32_t
arcmsr_Read_iop_rqbuffer_data(struct AdapterControlBlock *acb,
	struct QBUFFER __iomem *prbuffer) {

	uint8_t *pQbuffer;
	uint8_t __iomem *iop_data;
	uint32_t iop_len;

1750
	if (acb->adapter_type & (ACB_ADAPTER_TYPE_C | ACB_ADAPTER_TYPE_D))
1751 1752 1753 1754 1755 1756 1757 1758 1759 1760
		return arcmsr_Read_iop_rqbuffer_in_DWORD(acb, prbuffer);
	iop_data = (uint8_t __iomem *)prbuffer->data;
	iop_len = readl(&prbuffer->data_len);
	while (iop_len > 0) {
		pQbuffer = &acb->rqbuffer[acb->rqbuf_lastindex];
		*pQbuffer = readb(iop_data);
		acb->rqbuf_lastindex++;
		acb->rqbuf_lastindex %= ARCMSR_MAX_QBUFFER;
		iop_data++;
		iop_len--;
1761
	}
1762 1763 1764
	arcmsr_iop_message_read(acb);
	return 1;
}
1765

1766 1767 1768 1769 1770 1771 1772 1773 1774 1775 1776 1777 1778 1779
static void arcmsr_iop2drv_data_wrote_handle(struct AdapterControlBlock *acb)
{
	unsigned long flags;
	struct QBUFFER __iomem  *prbuffer;
	int32_t buf_empty_len;

	spin_lock_irqsave(&acb->rqbuffer_lock, flags);
	prbuffer = arcmsr_get_iop_rqbuffer(acb);
	buf_empty_len = (acb->rqbuf_lastindex - acb->rqbuf_firstindex - 1) &
		(ARCMSR_MAX_QBUFFER - 1);
	if (buf_empty_len >= readl(&prbuffer->data_len)) {
		if (arcmsr_Read_iop_rqbuffer_data(acb, prbuffer) == 0)
			acb->acb_flags |= ACB_F_IOPDATA_OVERFLOW;
	} else
1780
		acb->acb_flags |= ACB_F_IOPDATA_OVERFLOW;
1781 1782 1783 1784 1785 1786 1787 1788 1789 1790 1791 1792 1793 1794 1795 1796 1797 1798 1799 1800 1801 1802 1803 1804 1805 1806 1807 1808 1809 1810 1811 1812 1813 1814 1815 1816 1817 1818 1819 1820 1821 1822 1823 1824
	spin_unlock_irqrestore(&acb->rqbuffer_lock, flags);
}

static void arcmsr_write_ioctldata2iop_in_DWORD(struct AdapterControlBlock *acb)
{
	uint8_t *pQbuffer;
	struct QBUFFER __iomem *pwbuffer;
	uint8_t *buf1 = NULL;
	uint32_t __iomem *iop_data;
	uint32_t allxfer_len = 0, data_len, *buf2 = NULL, data;

	if (acb->acb_flags & ACB_F_MESSAGE_WQBUFFER_READED) {
		buf1 = kmalloc(128, GFP_ATOMIC);
		buf2 = (uint32_t *)buf1;
		if (buf1 == NULL)
			return;

		acb->acb_flags &= (~ACB_F_MESSAGE_WQBUFFER_READED);
		pwbuffer = arcmsr_get_iop_wqbuffer(acb);
		iop_data = (uint32_t __iomem *)pwbuffer->data;
		while ((acb->wqbuf_firstindex != acb->wqbuf_lastindex)
			&& (allxfer_len < 124)) {
			pQbuffer = &acb->wqbuffer[acb->wqbuf_firstindex];
			*buf1 = *pQbuffer;
			acb->wqbuf_firstindex++;
			acb->wqbuf_firstindex %= ARCMSR_MAX_QBUFFER;
			buf1++;
			allxfer_len++;
		}
		data_len = allxfer_len;
		buf1 = (uint8_t *)buf2;
		while (data_len >= 4) {
			data = *buf2++;
			writel(data, iop_data);
			iop_data++;
			data_len -= 4;
		}
		if (data_len) {
			data = *buf2;
			writel(data, iop_data);
		}
		writel(allxfer_len, &pwbuffer->data_len);
		kfree(buf1);
		arcmsr_iop_message_wrote(acb);
1825 1826 1827
	}
}

1828 1829
void
arcmsr_write_ioctldata2iop(struct AdapterControlBlock *acb)
1830
{
1831 1832 1833 1834
	uint8_t *pQbuffer;
	struct QBUFFER __iomem *pwbuffer;
	uint8_t __iomem *iop_data;
	int32_t allxfer_len = 0;
1835

1836
	if (acb->adapter_type & (ACB_ADAPTER_TYPE_C | ACB_ADAPTER_TYPE_D)) {
1837 1838 1839 1840
		arcmsr_write_ioctldata2iop_in_DWORD(acb);
		return;
	}
	if (acb->acb_flags & ACB_F_MESSAGE_WQBUFFER_READED) {
1841 1842 1843
		acb->acb_flags &= (~ACB_F_MESSAGE_WQBUFFER_READED);
		pwbuffer = arcmsr_get_iop_wqbuffer(acb);
		iop_data = (uint8_t __iomem *)pwbuffer->data;
1844 1845
		while ((acb->wqbuf_firstindex != acb->wqbuf_lastindex)
			&& (allxfer_len < 124)) {
1846
			pQbuffer = &acb->wqbuffer[acb->wqbuf_firstindex];
1847
			writeb(*pQbuffer, iop_data);
1848 1849 1850 1851 1852
			acb->wqbuf_firstindex++;
			acb->wqbuf_firstindex %= ARCMSR_MAX_QBUFFER;
			iop_data++;
			allxfer_len++;
		}
1853
		writel(allxfer_len, &pwbuffer->data_len);
1854 1855
		arcmsr_iop_message_wrote(acb);
	}
1856
}
1857

1858 1859 1860 1861 1862 1863 1864 1865 1866
static void arcmsr_iop2drv_data_read_handle(struct AdapterControlBlock *acb)
{
	unsigned long flags;

	spin_lock_irqsave(&acb->wqbuffer_lock, flags);
	acb->acb_flags |= ACB_F_MESSAGE_WQBUFFER_READED;
	if (acb->wqbuf_firstindex != acb->wqbuf_lastindex)
		arcmsr_write_ioctldata2iop(acb);
	if (acb->wqbuf_firstindex == acb->wqbuf_lastindex)
1867
		acb->acb_flags |= ACB_F_MESSAGE_WQBUFFER_CLEARED;
1868
	spin_unlock_irqrestore(&acb->wqbuffer_lock, flags);
1869 1870
}

1871
static void arcmsr_hbaA_doorbell_isr(struct AdapterControlBlock *acb)
1872 1873
{
	uint32_t outbound_doorbell;
A
Al Viro 已提交
1874
	struct MessageUnit_A __iomem *reg = acb->pmuA;
1875
	outbound_doorbell = readl(&reg->outbound_doorbell);
1876 1877 1878 1879 1880 1881 1882 1883 1884
	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));
1885
}
1886
static void arcmsr_hbaC_doorbell_isr(struct AdapterControlBlock *pACB)
1887 1888
{
	uint32_t outbound_doorbell;
1889
	struct MessageUnit_C __iomem *reg = pACB->pmuC;
1890 1891 1892 1893 1894 1895 1896 1897
	/*
	*******************************************************************
	**  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);
1898 1899 1900 1901 1902 1903 1904 1905
	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)
1906
			arcmsr_hbaC_message_isr(pACB);
1907 1908 1909 1910
		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));
1911
}
1912 1913 1914 1915 1916 1917 1918 1919 1920 1921 1922 1923 1924 1925 1926 1927 1928 1929 1930 1931 1932

static void arcmsr_hbaD_doorbell_isr(struct AdapterControlBlock *pACB)
{
	uint32_t outbound_doorbell;
	struct MessageUnit_D  *pmu = pACB->pmuD;

	outbound_doorbell = readl(pmu->outbound_doorbell);
	do {
		writel(outbound_doorbell, pmu->outbound_doorbell);
		if (outbound_doorbell & ARCMSR_ARC1214_IOP2DRV_MESSAGE_CMD_DONE)
			arcmsr_hbaD_message_isr(pACB);
		if (outbound_doorbell & ARCMSR_ARC1214_IOP2DRV_DATA_WRITE_OK)
			arcmsr_iop2drv_data_wrote_handle(pACB);
		if (outbound_doorbell & ARCMSR_ARC1214_IOP2DRV_DATA_READ_OK)
			arcmsr_iop2drv_data_read_handle(pACB);
		outbound_doorbell = readl(pmu->outbound_doorbell);
	} while (outbound_doorbell & (ARCMSR_ARC1214_IOP2DRV_DATA_WRITE_OK
		| ARCMSR_ARC1214_IOP2DRV_DATA_READ_OK
		| ARCMSR_ARC1214_IOP2DRV_MESSAGE_CMD_DONE));
}

1933
static void arcmsr_hbaA_postqueue_isr(struct AdapterControlBlock *acb)
1934 1935
{
	uint32_t flag_ccb;
A
Al Viro 已提交
1936
	struct MessageUnit_A __iomem *reg = acb->pmuA;
1937 1938 1939
	struct ARCMSR_CDB *pARCMSR_CDB;
	struct CommandControlBlock *pCCB;
	bool error;
1940
	while ((flag_ccb = readl(&reg->outbound_queueport)) != 0xFFFFFFFF) {
1941 1942 1943 1944
		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);
1945 1946
	}
}
1947
static void arcmsr_hbaB_postqueue_isr(struct AdapterControlBlock *acb)
1948 1949 1950
{
	uint32_t index;
	uint32_t flag_ccb;
A
Al Viro 已提交
1951
	struct MessageUnit_B *reg = acb->pmuB;
1952 1953 1954
	struct ARCMSR_CDB *pARCMSR_CDB;
	struct CommandControlBlock *pCCB;
	bool error;
1955
	index = reg->doneq_index;
1956 1957
	while ((flag_ccb = reg->done_qbuffer[index]) != 0) {
		reg->done_qbuffer[index] = 0;
1958 1959 1960 1961
		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);
1962 1963 1964 1965 1966
		index++;
		index %= ARCMSR_MAX_HBB_POSTQUEUE;
		reg->doneq_index = index;
	}
}
1967

1968
static void arcmsr_hbaC_postqueue_isr(struct AdapterControlBlock *acb)
1969
{
1970
	struct MessageUnit_C __iomem *phbcmu;
1971 1972 1973 1974 1975
	struct ARCMSR_CDB *arcmsr_cdb;
	struct CommandControlBlock *ccb;
	uint32_t flag_ccb, ccb_cdb_phy, throttling = 0;
	int error;

1976
	phbcmu = acb->pmuC;
1977 1978 1979
	/* areca cdb command done */
	/* Use correct offset and size for syncing */

1980 1981 1982 1983 1984 1985 1986 1987 1988 1989 1990 1991 1992 1993 1994 1995 1996
	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;
		}
1997 1998
	}
}
1999 2000 2001 2002 2003 2004 2005 2006 2007 2008 2009 2010 2011 2012 2013 2014 2015 2016 2017 2018 2019 2020 2021 2022 2023 2024 2025 2026 2027 2028 2029 2030 2031 2032 2033 2034 2035 2036 2037 2038 2039 2040 2041 2042 2043 2044 2045 2046 2047 2048 2049 2050 2051

static void arcmsr_hbaD_postqueue_isr(struct AdapterControlBlock *acb)
{
	u32 outbound_write_pointer, doneq_index, index_stripped;
	uint32_t addressLow, ccb_cdb_phy;
	int error;
	struct MessageUnit_D  *pmu;
	struct ARCMSR_CDB *arcmsr_cdb;
	struct CommandControlBlock *ccb;
	unsigned long flags;

	spin_lock_irqsave(&acb->doneq_lock, flags);
	pmu = acb->pmuD;
	outbound_write_pointer = pmu->done_qbuffer[0].addressLow + 1;
	doneq_index = pmu->doneq_index;
	if ((doneq_index & 0xFFF) != (outbound_write_pointer & 0xFFF)) {
		do {
			if (doneq_index & 0x4000) {
				index_stripped = doneq_index & 0xFFF;
				index_stripped += 1;
				index_stripped %= ARCMSR_MAX_ARC1214_DONEQUEUE;
				pmu->doneq_index = index_stripped
					? (index_stripped | 0x4000) :
					(index_stripped + 1);
			} else {
				index_stripped = doneq_index;
				index_stripped += 1;
				index_stripped %= ARCMSR_MAX_ARC1214_DONEQUEUE;
				pmu->doneq_index = index_stripped
					? index_stripped :
					((index_stripped | 0x4000) + 1);
			}
			doneq_index = pmu->doneq_index;
			addressLow = pmu->done_qbuffer[doneq_index &
				0xFFF].addressLow;
			ccb_cdb_phy = (addressLow & 0xFFFFFFF0);
			arcmsr_cdb = (struct ARCMSR_CDB *)(acb->vir2phy_offset
				+ ccb_cdb_phy);
			ccb = container_of(arcmsr_cdb,
				struct CommandControlBlock, arcmsr_cdb);
			error = (addressLow & ARCMSR_CCBREPLY_FLAG_ERROR_MODE1)
				? true : false;
			arcmsr_drain_donequeue(acb, ccb, error);
			writel(doneq_index, pmu->outboundlist_read_pointer);
		} while ((doneq_index & 0xFFF) !=
			(outbound_write_pointer & 0xFFF));
	}
	writel(ARCMSR_ARC1214_OUTBOUND_LIST_INTERRUPT_CLEAR,
		pmu->outboundlist_interrupt_cause);
	readl(pmu->outboundlist_interrupt_cause);
	spin_unlock_irqrestore(&acb->doneq_lock, flags);
}

2052 2053 2054 2055
/*
**********************************************************************************
** Handle a message interrupt
**
2056
** The only message interrupt we expect is in response to a query for the current adapter config.  
2057 2058 2059
** We want this in order to compare the drivemap so that we can detect newly-attached drives.
**********************************************************************************
*/
2060
static void arcmsr_hbaA_message_isr(struct AdapterControlBlock *acb)
2061
{
2062
	struct MessageUnit_A __iomem *reg  = acb->pmuA;
2063 2064 2065 2066
	/*clear interrupt and message state*/
	writel(ARCMSR_MU_OUTBOUND_MESSAGE0_INT, &reg->outbound_intstatus);
	schedule_work(&acb->arcmsr_do_message_isr_bh);
}
2067
static void arcmsr_hbaB_message_isr(struct AdapterControlBlock *acb)
2068 2069
{
	struct MessageUnit_B *reg  = acb->pmuB;
2070

2071
	/*clear interrupt and message state*/
2072
	writel(ARCMSR_MESSAGE_INT_CLEAR_PATTERN, reg->iop2drv_doorbell);
2073 2074
	schedule_work(&acb->arcmsr_do_message_isr_bh);
}
2075 2076 2077 2078 2079 2080 2081 2082 2083
/*
**********************************************************************************
** 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.
**********************************************************************************
*/
2084
static void arcmsr_hbaC_message_isr(struct AdapterControlBlock *acb)
2085
{
2086
	struct MessageUnit_C __iomem *reg  = acb->pmuC;
2087 2088 2089 2090 2091
	/*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);
}

2092 2093 2094 2095 2096 2097 2098 2099 2100
static void arcmsr_hbaD_message_isr(struct AdapterControlBlock *acb)
{
	struct MessageUnit_D *reg  = acb->pmuD;

	writel(ARCMSR_ARC1214_IOP2DRV_MESSAGE_CMD_DONE, reg->outbound_doorbell);
	readl(reg->outbound_doorbell);
	schedule_work(&acb->arcmsr_do_message_isr_bh);
}

2101
static int arcmsr_hbaA_handle_isr(struct AdapterControlBlock *acb)
2102 2103
{
	uint32_t outbound_intstatus;
A
Al Viro 已提交
2104
	struct MessageUnit_A __iomem *reg = acb->pmuA;
2105
	outbound_intstatus = readl(&reg->outbound_intstatus) &
2106
		acb->outbound_int_enable;
2107 2108 2109 2110 2111
	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)
2112
			arcmsr_hbaA_doorbell_isr(acb);
2113
		if (outbound_intstatus & ARCMSR_MU_OUTBOUND_POSTQUEUE_INT)
2114
			arcmsr_hbaA_postqueue_isr(acb);
2115
		if (outbound_intstatus & ARCMSR_MU_OUTBOUND_MESSAGE0_INT)
2116
			arcmsr_hbaA_message_isr(acb);
2117 2118 2119 2120 2121 2122
		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;
2123 2124
}

2125
static int arcmsr_hbaB_handle_isr(struct AdapterControlBlock *acb)
2126 2127
{
	uint32_t outbound_doorbell;
A
Al Viro 已提交
2128
	struct MessageUnit_B *reg = acb->pmuB;
2129
	outbound_doorbell = readl(reg->iop2drv_doorbell) &
2130
				acb->outbound_int_enable;
2131
	if (!outbound_doorbell)
2132 2133 2134 2135 2136 2137 2138 2139 2140
		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)
2141
			arcmsr_hbaB_postqueue_isr(acb);
2142
		if (outbound_doorbell & ARCMSR_IOP2DRV_MESSAGE_CMD_DONE)
2143
			arcmsr_hbaB_message_isr(acb);
2144 2145 2146 2147 2148 2149 2150
		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;
2151 2152
}

2153
static int arcmsr_hbaC_handle_isr(struct AdapterControlBlock *pACB)
2154 2155
{
	uint32_t host_interrupt_status;
2156
	struct MessageUnit_C __iomem *phbcmu = pACB->pmuC;
2157 2158 2159 2160 2161
	/*
	*********************************************
	**   check outbound intstatus
	*********************************************
	*/
2162 2163 2164 2165 2166 2167 2168
	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)
2169
			arcmsr_hbaC_doorbell_isr(pACB);
2170 2171
		/* MU post queue interrupts*/
		if (host_interrupt_status & ARCMSR_HBCMU_OUTBOUND_POSTQUEUE_ISR)
2172
			arcmsr_hbaC_postqueue_isr(pACB);
2173 2174 2175 2176
		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;
2177
}
2178 2179 2180 2181 2182 2183 2184 2185 2186 2187 2188 2189 2190 2191 2192 2193 2194 2195 2196 2197 2198 2199 2200 2201 2202 2203

static irqreturn_t arcmsr_hbaD_handle_isr(struct AdapterControlBlock *pACB)
{
	u32 host_interrupt_status;
	struct MessageUnit_D  *pmu = pACB->pmuD;

	host_interrupt_status = readl(pmu->host_int_status) &
		(ARCMSR_ARC1214_OUTBOUND_POSTQUEUE_ISR |
		ARCMSR_ARC1214_OUTBOUND_DOORBELL_ISR);
	if (!host_interrupt_status)
		return IRQ_NONE;
	do {
		/* MU post queue interrupts*/
		if (host_interrupt_status &
			ARCMSR_ARC1214_OUTBOUND_POSTQUEUE_ISR)
			arcmsr_hbaD_postqueue_isr(pACB);
		if (host_interrupt_status &
			ARCMSR_ARC1214_OUTBOUND_DOORBELL_ISR)
			arcmsr_hbaD_doorbell_isr(pACB);
		host_interrupt_status = readl(pmu->host_int_status);
	} while (host_interrupt_status &
		(ARCMSR_ARC1214_OUTBOUND_POSTQUEUE_ISR |
		ARCMSR_ARC1214_OUTBOUND_DOORBELL_ISR));
	return IRQ_HANDLED;
}

2204 2205 2206
static irqreturn_t arcmsr_interrupt(struct AdapterControlBlock *acb)
{
	switch (acb->adapter_type) {
2207
	case ACB_ADAPTER_TYPE_A:
2208
		return arcmsr_hbaA_handle_isr(acb);
2209
		break;
2210
	case ACB_ADAPTER_TYPE_B:
2211
		return arcmsr_hbaB_handle_isr(acb);
2212
		break;
2213
	case ACB_ADAPTER_TYPE_C:
2214
		return arcmsr_hbaC_handle_isr(acb);
2215 2216
	case ACB_ADAPTER_TYPE_D:
		return arcmsr_hbaD_handle_isr(acb);
2217 2218
	default:
		return IRQ_NONE;
2219 2220 2221 2222 2223 2224 2225 2226
	}
}

static void arcmsr_iop_parking(struct AdapterControlBlock *acb)
{
	if (acb) {
		/* stop adapter background rebuild */
		if (acb->acb_flags & ACB_F_MSG_START_BGRB) {
2227
			uint32_t intmask_org;
2228
			acb->acb_flags &= ~ACB_F_MSG_START_BGRB;
2229
			intmask_org = arcmsr_disable_outbound_ints(acb);
2230 2231
			arcmsr_stop_adapter_bgrb(acb);
			arcmsr_flush_adapter_cache(acb);
2232 2233 2234 2235 2236
			arcmsr_enable_outbound_ints(acb, intmask_org);
		}
	}
}

2237 2238

void arcmsr_clear_iop2drv_rqueue_buffer(struct AdapterControlBlock *acb)
2239
{
2240 2241 2242 2243 2244 2245 2246 2247 2248 2249 2250 2251 2252 2253 2254 2255 2256
	uint32_t	i;

	if (acb->acb_flags & ACB_F_IOPDATA_OVERFLOW) {
		for (i = 0; i < 15; i++) {
			if (acb->acb_flags & ACB_F_IOPDATA_OVERFLOW) {
				acb->acb_flags &= ~ACB_F_IOPDATA_OVERFLOW;
				acb->rqbuf_firstindex = 0;
				acb->rqbuf_lastindex = 0;
				arcmsr_iop_message_read(acb);
				mdelay(30);
			} else if (acb->rqbuf_firstindex !=
				   acb->rqbuf_lastindex) {
				acb->rqbuf_firstindex = 0;
				acb->rqbuf_lastindex = 0;
				mdelay(30);
			} else
				break;
2257 2258 2259 2260
		}
	}
}

2261
static int arcmsr_iop_message_xfer(struct AdapterControlBlock *acb,
2262
		struct scsi_cmnd *cmd)
2263 2264
{
	char *buffer;
2265 2266 2267 2268 2269 2270 2271 2272
	unsigned short use_sg;
	int retvalue = 0, transfer_len = 0;
	unsigned long flags;
	struct CMD_MESSAGE_FIELD *pcmdmessagefld;
	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];
2273
	struct scatterlist *sg;
2274 2275

	use_sg = scsi_sg_count(cmd);
2276
	sg = scsi_sglist(cmd);
2277
	buffer = kmap_atomic(sg_page(sg)) + sg->offset;
2278
	if (use_sg > 1) {
2279 2280
		retvalue = ARCMSR_MESSAGE_FAIL;
		goto message_out;
2281
	}
2282
	transfer_len += sg->length;
2283 2284
	if (transfer_len > sizeof(struct CMD_MESSAGE_FIELD)) {
		retvalue = ARCMSR_MESSAGE_FAIL;
2285
		pr_info("%s: ARCMSR_MESSAGE_FAIL!\n", __func__);
2286 2287
		goto message_out;
	}
2288 2289
	pcmdmessagefld = (struct CMD_MESSAGE_FIELD *)buffer;
	switch (controlcode) {
2290
	case ARCMSR_MESSAGE_READ_RQBUFFER: {
2291
		unsigned char *ver_addr;
2292
		uint8_t *pQbuffer, *ptmpQbuffer;
2293
		uint32_t allxfer_len = 0;
2294 2295
		ver_addr = kmalloc(1032, GFP_ATOMIC);
		if (!ver_addr) {
2296
			retvalue = ARCMSR_MESSAGE_FAIL;
2297
			pr_info("%s: memory not enough!\n", __func__);
2298 2299
			goto message_out;
		}
2300
		ptmpQbuffer = ver_addr;
2301 2302
		spin_lock_irqsave(&acb->rqbuffer_lock, flags);
		if (acb->rqbuf_firstindex != acb->rqbuf_lastindex) {
2303
			pQbuffer = &acb->rqbuffer[acb->rqbuf_firstindex];
2304 2305 2306 2307 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 2353 2354 2355 2356 2357 2358 2359 2360 2361
			if (acb->rqbuf_firstindex > acb->rqbuf_lastindex) {
				if ((ARCMSR_MAX_QBUFFER -
					acb->rqbuf_firstindex) >= 1032) {
					memcpy(ptmpQbuffer, pQbuffer, 1032);
					acb->rqbuf_firstindex += 1032;
					acb->rqbuf_firstindex %= ARCMSR_MAX_QBUFFER;
					allxfer_len = 1032;
				} else {
					if (((ARCMSR_MAX_QBUFFER -
						acb->rqbuf_firstindex) +
						acb->rqbuf_lastindex) > 1032) {
						memcpy(ptmpQbuffer,
							pQbuffer, ARCMSR_MAX_QBUFFER
							- acb->rqbuf_firstindex);
						ptmpQbuffer +=
							ARCMSR_MAX_QBUFFER -
							acb->rqbuf_firstindex;
						memcpy(ptmpQbuffer,
							acb->rqbuffer, 1032 -
							(ARCMSR_MAX_QBUFFER
							- acb->rqbuf_firstindex));
						acb->rqbuf_firstindex =
							1032 - (ARCMSR_MAX_QBUFFER
							- acb->rqbuf_firstindex);
						allxfer_len = 1032;
					} else {
						memcpy(ptmpQbuffer,
							pQbuffer, ARCMSR_MAX_QBUFFER
							- acb->rqbuf_firstindex);
						ptmpQbuffer +=
							ARCMSR_MAX_QBUFFER -
							acb->rqbuf_firstindex;
						memcpy(ptmpQbuffer,
							acb->rqbuffer,
							acb->rqbuf_lastindex);
						allxfer_len = ARCMSR_MAX_QBUFFER
							- acb->rqbuf_firstindex +
							acb->rqbuf_lastindex;
						acb->rqbuf_firstindex =
							acb->rqbuf_lastindex;
					}
				}
			} else {
				if ((acb->rqbuf_lastindex -
					acb->rqbuf_firstindex) > 1032) {
					memcpy(ptmpQbuffer, pQbuffer, 1032);
					acb->rqbuf_firstindex += 1032;
					allxfer_len = 1032;
				} else {
					memcpy(ptmpQbuffer, pQbuffer,
						acb->rqbuf_lastindex -
						acb->rqbuf_firstindex);
					allxfer_len = acb->rqbuf_lastindex
						- acb->rqbuf_firstindex;
					acb->rqbuf_firstindex =
						acb->rqbuf_lastindex;
				}
			}
2362
		}
2363 2364
		memcpy(pcmdmessagefld->messagedatabuffer, ver_addr,
			allxfer_len);
2365
		if (acb->acb_flags & ACB_F_IOPDATA_OVERFLOW) {
A
Al Viro 已提交
2366
			struct QBUFFER __iomem *prbuffer;
2367 2368
			acb->acb_flags &= ~ACB_F_IOPDATA_OVERFLOW;
			prbuffer = arcmsr_get_iop_rqbuffer(acb);
2369 2370
			if (arcmsr_Read_iop_rqbuffer_data(acb, prbuffer) == 0)
				acb->acb_flags |= ACB_F_IOPDATA_OVERFLOW;
2371
		}
2372
		spin_unlock_irqrestore(&acb->rqbuffer_lock, flags);
2373
		kfree(ver_addr);
2374 2375 2376 2377 2378 2379 2380
		pcmdmessagefld->cmdmessage.Length = allxfer_len;
		if (acb->fw_flag == FW_DEADLOCK)
			pcmdmessagefld->cmdmessage.ReturnCode =
				ARCMSR_MESSAGE_RETURNCODE_BUS_HANG_ON;
		else
			pcmdmessagefld->cmdmessage.ReturnCode =
				ARCMSR_MESSAGE_RETURNCODE_OK;
2381
		break;
2382
	}
2383
	case ARCMSR_MESSAGE_WRITE_WQBUFFER: {
2384
		unsigned char *ver_addr;
2385 2386
		int32_t my_empty_len, user_len, wqbuf_firstindex, wqbuf_lastindex;
		uint8_t *pQbuffer, *ptmpuserbuffer;
2387 2388
		ver_addr = kmalloc(1032, GFP_ATOMIC);
		if (!ver_addr) {
2389 2390 2391
			retvalue = ARCMSR_MESSAGE_FAIL;
			goto message_out;
		}
2392
		ptmpuserbuffer = ver_addr;
2393
		user_len = pcmdmessagefld->cmdmessage.Length;
2394 2395 2396
		memcpy(ptmpuserbuffer,
			pcmdmessagefld->messagedatabuffer, user_len);
		spin_lock_irqsave(&acb->wqbuffer_lock, flags);
2397 2398 2399 2400 2401
		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;
2402
			arcmsr_write_ioctldata2iop(acb);
2403
			/* has error report sensedata */
2404
			sensebuffer->ErrorCode = SCSI_SENSE_CURRENT_ERRORS;
2405 2406 2407 2408 2409 2410
			sensebuffer->SenseKey = ILLEGAL_REQUEST;
			sensebuffer->AdditionalSenseLength = 0x0A;
			sensebuffer->AdditionalSenseCode = 0x20;
			sensebuffer->Valid = 1;
			retvalue = ARCMSR_MESSAGE_FAIL;
		} else {
2411 2412
			my_empty_len = (wqbuf_firstindex - wqbuf_lastindex - 1)
				& (ARCMSR_MAX_QBUFFER - 1);
2413 2414
			if (my_empty_len >= user_len) {
				while (user_len > 0) {
2415 2416 2417 2418 2419 2420 2421 2422 2423 2424 2425 2426 2427 2428 2429 2430 2431 2432 2433 2434
					pQbuffer = &acb->wqbuffer[acb->wqbuf_lastindex];
					if ((acb->wqbuf_lastindex + user_len)
						> ARCMSR_MAX_QBUFFER) {
						memcpy(pQbuffer, ptmpuserbuffer,
							ARCMSR_MAX_QBUFFER -
							acb->wqbuf_lastindex);
						ptmpuserbuffer +=
							(ARCMSR_MAX_QBUFFER
							- acb->wqbuf_lastindex);
						user_len -= (ARCMSR_MAX_QBUFFER
							- acb->wqbuf_lastindex);
						acb->wqbuf_lastindex = 0;
					} else {
						memcpy(pQbuffer, ptmpuserbuffer,
							user_len);
						acb->wqbuf_lastindex += user_len;
						acb->wqbuf_lastindex %=
							ARCMSR_MAX_QBUFFER;
						user_len = 0;
					}
2435
				}
2436 2437
				if (acb->acb_flags &
					ACB_F_MESSAGE_WQBUFFER_CLEARED) {
2438 2439
					acb->acb_flags &=
						~ACB_F_MESSAGE_WQBUFFER_CLEARED;
2440
					arcmsr_write_ioctldata2iop(acb);
2441 2442
				}
			} else {
2443 2444
				struct SENSE_DATA *sensebuffer =
					(struct SENSE_DATA *)cmd->sense_buffer;
2445 2446 2447
				/* has error report sensedata */
				sensebuffer->ErrorCode =
					SCSI_SENSE_CURRENT_ERRORS;
2448 2449 2450 2451 2452
				sensebuffer->SenseKey = ILLEGAL_REQUEST;
				sensebuffer->AdditionalSenseLength = 0x0A;
				sensebuffer->AdditionalSenseCode = 0x20;
				sensebuffer->Valid = 1;
				retvalue = ARCMSR_MESSAGE_FAIL;
2453
			}
2454
		}
2455 2456 2457 2458 2459 2460 2461 2462
		spin_unlock_irqrestore(&acb->wqbuffer_lock, flags);
		kfree(ver_addr);
		if (acb->fw_flag == FW_DEADLOCK)
			pcmdmessagefld->cmdmessage.ReturnCode =
				ARCMSR_MESSAGE_RETURNCODE_BUS_HANG_ON;
		else
			pcmdmessagefld->cmdmessage.ReturnCode =
				ARCMSR_MESSAGE_RETURNCODE_OK;
2463
		break;
2464
	}
2465
	case ARCMSR_MESSAGE_CLEAR_RQBUFFER: {
2466
		uint8_t *pQbuffer = acb->rqbuffer;
2467 2468 2469

		arcmsr_clear_iop2drv_rqueue_buffer(acb);
		spin_lock_irqsave(&acb->rqbuffer_lock, flags);
2470 2471 2472 2473
		acb->acb_flags |= ACB_F_MESSAGE_RQBUFFER_CLEARED;
		acb->rqbuf_firstindex = 0;
		acb->rqbuf_lastindex = 0;
		memset(pQbuffer, 0, ARCMSR_MAX_QBUFFER);
2474 2475
		spin_unlock_irqrestore(&acb->rqbuffer_lock, flags);
		if (acb->fw_flag == FW_DEADLOCK)
2476
			pcmdmessagefld->cmdmessage.ReturnCode =
2477 2478
				ARCMSR_MESSAGE_RETURNCODE_BUS_HANG_ON;
		else
2479
			pcmdmessagefld->cmdmessage.ReturnCode =
2480
				ARCMSR_MESSAGE_RETURNCODE_OK;
2481
		break;
2482
	}
2483
	case ARCMSR_MESSAGE_CLEAR_WQBUFFER: {
2484
		uint8_t *pQbuffer = acb->wqbuffer;
2485 2486 2487
		spin_lock_irqsave(&acb->wqbuffer_lock, flags);
		acb->acb_flags |= (ACB_F_MESSAGE_WQBUFFER_CLEARED |
			ACB_F_MESSAGE_WQBUFFER_READED);
2488 2489 2490
		acb->wqbuf_firstindex = 0;
		acb->wqbuf_lastindex = 0;
		memset(pQbuffer, 0, ARCMSR_MAX_QBUFFER);
2491 2492 2493 2494 2495 2496 2497
		spin_unlock_irqrestore(&acb->wqbuffer_lock, flags);
		if (acb->fw_flag == FW_DEADLOCK)
			pcmdmessagefld->cmdmessage.ReturnCode =
				ARCMSR_MESSAGE_RETURNCODE_BUS_HANG_ON;
		else
			pcmdmessagefld->cmdmessage.ReturnCode =
				ARCMSR_MESSAGE_RETURNCODE_OK;
2498
		break;
2499
	}
2500
	case ARCMSR_MESSAGE_CLEAR_ALLQBUFFER: {
2501
		uint8_t *pQbuffer;
2502 2503 2504
		arcmsr_clear_iop2drv_rqueue_buffer(acb);
		spin_lock_irqsave(&acb->rqbuffer_lock, flags);
		acb->acb_flags |= ACB_F_MESSAGE_RQBUFFER_CLEARED;
2505 2506 2507 2508
		acb->rqbuf_firstindex = 0;
		acb->rqbuf_lastindex = 0;
		pQbuffer = acb->rqbuffer;
		memset(pQbuffer, 0, sizeof(struct QBUFFER));
2509 2510 2511 2512 2513 2514
		spin_unlock_irqrestore(&acb->rqbuffer_lock, flags);
		spin_lock_irqsave(&acb->wqbuffer_lock, flags);
		acb->acb_flags |= (ACB_F_MESSAGE_WQBUFFER_CLEARED |
			ACB_F_MESSAGE_WQBUFFER_READED);
		acb->wqbuf_firstindex = 0;
		acb->wqbuf_lastindex = 0;
2515 2516
		pQbuffer = acb->wqbuffer;
		memset(pQbuffer, 0, sizeof(struct QBUFFER));
2517 2518
		spin_unlock_irqrestore(&acb->wqbuffer_lock, flags);
		if (acb->fw_flag == FW_DEADLOCK)
2519
			pcmdmessagefld->cmdmessage.ReturnCode =
2520 2521
				ARCMSR_MESSAGE_RETURNCODE_BUS_HANG_ON;
		else
2522
			pcmdmessagefld->cmdmessage.ReturnCode =
2523
				ARCMSR_MESSAGE_RETURNCODE_OK;
2524
		break;
2525
	}
2526
	case ARCMSR_MESSAGE_RETURN_CODE_3F: {
2527
		if (acb->fw_flag == FW_DEADLOCK)
2528
			pcmdmessagefld->cmdmessage.ReturnCode =
2529 2530
				ARCMSR_MESSAGE_RETURNCODE_BUS_HANG_ON;
		else
2531
			pcmdmessagefld->cmdmessage.ReturnCode =
2532
				ARCMSR_MESSAGE_RETURNCODE_3F;
2533
		break;
2534
	}
2535
	case ARCMSR_MESSAGE_SAY_HELLO: {
2536
		int8_t *hello_string = "Hello! I am ARCMSR";
2537
		if (acb->fw_flag == FW_DEADLOCK)
2538
			pcmdmessagefld->cmdmessage.ReturnCode =
2539 2540
				ARCMSR_MESSAGE_RETURNCODE_BUS_HANG_ON;
		else
2541
			pcmdmessagefld->cmdmessage.ReturnCode =
2542 2543 2544
				ARCMSR_MESSAGE_RETURNCODE_OK;
		memcpy(pcmdmessagefld->messagedatabuffer,
			hello_string, (int16_t)strlen(hello_string));
2545
		break;
2546 2547 2548
	}
	case ARCMSR_MESSAGE_SAY_GOODBYE: {
		if (acb->fw_flag == FW_DEADLOCK)
2549
			pcmdmessagefld->cmdmessage.ReturnCode =
2550 2551 2552 2553
				ARCMSR_MESSAGE_RETURNCODE_BUS_HANG_ON;
		else
			pcmdmessagefld->cmdmessage.ReturnCode =
				ARCMSR_MESSAGE_RETURNCODE_OK;
2554 2555
		arcmsr_iop_parking(acb);
		break;
2556 2557 2558
	}
	case ARCMSR_MESSAGE_FLUSH_ADAPTER_CACHE: {
		if (acb->fw_flag == FW_DEADLOCK)
2559
			pcmdmessagefld->cmdmessage.ReturnCode =
2560 2561 2562 2563
				ARCMSR_MESSAGE_RETURNCODE_BUS_HANG_ON;
		else
			pcmdmessagefld->cmdmessage.ReturnCode =
				ARCMSR_MESSAGE_RETURNCODE_OK;
2564 2565
		arcmsr_flush_adapter_cache(acb);
		break;
2566
	}
2567 2568
	default:
		retvalue = ARCMSR_MESSAGE_FAIL;
2569 2570 2571 2572 2573 2574
		pr_info("%s: unknown controlcode!\n", __func__);
	}
message_out:
	if (use_sg) {
		struct scatterlist *sg = scsi_sglist(cmd);
		kunmap_atomic(buffer - sg->offset);
2575 2576 2577 2578 2579 2580 2581 2582
	}
	return retvalue;
}

static struct CommandControlBlock *arcmsr_get_freeccb(struct AdapterControlBlock *acb)
{
	struct list_head *head = &acb->ccb_free_list;
	struct CommandControlBlock *ccb = NULL;
2583 2584
	unsigned long flags;
	spin_lock_irqsave(&acb->ccblist_lock, flags);
2585 2586
	if (!list_empty(head)) {
		ccb = list_entry(head->next, struct CommandControlBlock, list);
2587
		list_del_init(&ccb->list);
2588
	}else{
2589
		spin_unlock_irqrestore(&acb->ccblist_lock, flags);
2590
		return NULL;
2591
	}
2592
	spin_unlock_irqrestore(&acb->ccblist_lock, flags);
2593 2594 2595 2596 2597 2598 2599 2600 2601 2602
	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;
2603
		struct scatterlist *sg;
2604 2605 2606 2607 2608 2609 2610 2611 2612 2613 2614

		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;
2615
		/* ISO, ECMA, & ANSI versions */
2616 2617 2618 2619 2620 2621 2622 2623
		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 */

2624
		sg = scsi_sglist(cmd);
2625
		buffer = kmap_atomic(sg_page(sg)) + sg->offset;
2626

2627
		memcpy(buffer, inqdata, sizeof(inqdata));
2628
		sg = scsi_sglist(cmd);
2629
		kunmap_atomic(buffer - sg->offset);
2630 2631 2632 2633 2634 2635 2636 2637 2638 2639 2640 2641 2642 2643 2644 2645

		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 已提交
2646
static int arcmsr_queue_command_lck(struct scsi_cmnd *cmd,
2647 2648 2649
	void (* done)(struct scsi_cmnd *))
{
	struct Scsi_Host *host = cmd->device->host;
2650
	struct AdapterControlBlock *acb = (struct AdapterControlBlock *) host->hostdata;
2651 2652 2653
	struct CommandControlBlock *ccb;
	int target = cmd->device->id;
	int lun = cmd->device->lun;
2654
	uint8_t scsicmd = cmd->cmnd[0];
2655 2656 2657
	cmd->scsi_done = done;
	cmd->host_scribble = NULL;
	cmd->result = 0;
2658 2659 2660
	if ((scsicmd == SYNCHRONIZE_CACHE) ||(scsicmd == SEND_DIAGNOSTIC)){
		if(acb->devstate[target][lun] == ARECA_RAID_GONE) {
    			cmd->result = (DID_NO_CONNECT << 16);
2661 2662 2663 2664
		}
		cmd->scsi_done(cmd);
		return 0;
	}
2665
	if (target == 16) {
2666 2667 2668 2669 2670 2671 2672
		/* 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;
2673
	if (arcmsr_build_ccb( acb, ccb, cmd ) == FAILED) {
N
Nick Cheng 已提交
2674 2675 2676 2677
		cmd->result = (DID_ERROR << 16) | (RESERVATION_CONFLICT << 1);
		cmd->scsi_done(cmd);
		return 0;
	}
2678 2679 2680 2681
	arcmsr_post_ccb(acb, ccb);
	return 0;
}

J
Jeff Garzik 已提交
2682 2683
static DEF_SCSI_QCMD(arcmsr_queue_command)

2684
static bool arcmsr_hbaA_get_config(struct AdapterControlBlock *acb)
2685
{
A
Al Viro 已提交
2686
	struct MessageUnit_A __iomem *reg = acb->pmuA;
2687 2688
	char *acb_firm_model = acb->firm_model;
	char *acb_firm_version = acb->firm_version;
2689
	char *acb_device_map = acb->device_map;
A
Al Viro 已提交
2690 2691
	char __iomem *iop_firm_model = (char __iomem *)(&reg->message_rwbuffer[15]);
	char __iomem *iop_firm_version = (char __iomem *)(&reg->message_rwbuffer[17]);
2692
	char __iomem *iop_device_map = (char __iomem *)(&reg->message_rwbuffer[21]);
2693 2694
	int count;
	writel(ARCMSR_INBOUND_MESG0_GET_CONFIG, &reg->inbound_msgaddr0);
2695
	if (!arcmsr_hbaA_wait_msgint_ready(acb)) {
2696 2697
		printk(KERN_NOTICE "arcmsr%d: wait 'get adapter firmware \
			miscellaneous data' timeout \n", acb->host->host_no);
2698
		return false;
2699
	}
2700
	count = 8;
2701
	while (count){
2702 2703 2704 2705 2706
		*acb_firm_model = readb(iop_firm_model);
		acb_firm_model++;
		iop_firm_model++;
		count--;
	}
2707

2708
	count = 16;
2709
	while (count){
2710 2711 2712 2713 2714
		*acb_firm_version = readb(iop_firm_version);
		acb_firm_version++;
		iop_firm_version++;
		count--;
	}
2715

2716 2717 2718 2719 2720 2721 2722
	count=16;
	while(count){
		*acb_device_map = readb(iop_device_map);
		acb_device_map++;
		iop_device_map++;
		count--;
	}
2723
	pr_notice("Areca RAID Controller%d: Model %s, F/W %s\n",
2724
		acb->host->host_no,
2725 2726
		acb->firm_model,
		acb->firm_version);
2727
	acb->signature = readl(&reg->message_rwbuffer[0]);
2728 2729 2730 2731
	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]);
2732 2733
	acb->firm_cfg_version = readl(&reg->message_rwbuffer[25]);  /*firm_cfg_version,25,100-103*/
	return true;
2734
}
2735
static bool arcmsr_hbaB_get_config(struct AdapterControlBlock *acb)
2736
{
A
Al Viro 已提交
2737
	struct MessageUnit_B *reg = acb->pmuB;
2738 2739 2740
	struct pci_dev *pdev = acb->pdev;
	void *dma_coherent;
	dma_addr_t dma_coherent_handle;
2741 2742
	char *acb_firm_model = acb->firm_model;
	char *acb_firm_version = acb->firm_version;
2743
	char *acb_device_map = acb->device_map;
2744
	char __iomem *iop_firm_model;
2745
	/*firm_model,15,60-67*/
2746
	char __iomem *iop_firm_version;
2747
	/*firm_version,17,68-83*/
2748
	char __iomem *iop_device_map;
2749
	/*firm_version,21,84-99*/
2750
	int count;
2751 2752 2753 2754

	acb->roundup_ccbsize = roundup(sizeof(struct MessageUnit_B), 32);
	dma_coherent = dma_alloc_coherent(&pdev->dev, acb->roundup_ccbsize,
			&dma_coherent_handle, GFP_KERNEL);
2755
	if (!dma_coherent){
2756 2757 2758
		printk(KERN_NOTICE
			"arcmsr%d: dma_alloc_coherent got error for hbb mu\n",
			acb->host->host_no);
2759 2760
		return false;
	}
2761
	acb->dma_coherent_handle2 = dma_coherent_handle;
2762
	acb->dma_coherent2 = dma_coherent;
2763 2764
	reg = (struct MessageUnit_B *)dma_coherent;
	acb->pmuB = reg;
2765
	reg->drv2iop_doorbell= (uint32_t __iomem *)((unsigned long)acb->mem_base0 + ARCMSR_DRV2IOP_DOORBELL);
2766 2767 2768 2769 2770 2771 2772 2773 2774 2775 2776
	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);
2777
	if (!arcmsr_hbaB_wait_msgint_ready(acb)) {
2778 2779
		printk(KERN_NOTICE "arcmsr%d: wait 'get adapter firmware \
			miscellaneous data' timeout \n", acb->host->host_no);
2780
		return false;
2781 2782
	}
	count = 8;
2783
	while (count){
2784 2785 2786 2787 2788 2789
		*acb_firm_model = readb(iop_firm_model);
		acb_firm_model++;
		iop_firm_model++;
		count--;
	}
	count = 16;
2790
	while (count){
2791 2792 2793 2794 2795 2796
		*acb_firm_version = readb(iop_firm_version);
		acb_firm_version++;
		iop_firm_version++;
		count--;
	}

2797 2798 2799 2800 2801 2802 2803 2804
	count = 16;
	while(count){
		*acb_device_map = readb(iop_device_map);
		acb_device_map++;
		iop_device_map++;
		count--;
	}
	
2805
	pr_notice("Areca RAID Controller%d: Model %s, F/W %s\n",
2806
		acb->host->host_no,
2807 2808
		acb->firm_model,
		acb->firm_version);
2809

2810
	acb->signature = readl(&reg->message_rwbuffer[1]);
2811
	/*firm_signature,1,00-03*/
2812
	acb->firm_request_len = readl(&reg->message_rwbuffer[2]);
2813
	/*firm_request_len,1,04-07*/
2814
	acb->firm_numbers_queue = readl(&reg->message_rwbuffer[3]);
2815
	/*firm_numbers_queue,2,08-11*/
2816
	acb->firm_sdram_size = readl(&reg->message_rwbuffer[4]);
2817
	/*firm_sdram_size,3,12-15*/
2818
	acb->firm_hd_channels = readl(&reg->message_rwbuffer[5]);
2819
	/*firm_ide_channels,4,16-19*/
2820 2821 2822
	acb->firm_cfg_version = readl(&reg->message_rwbuffer[25]);  /*firm_cfg_version,25,100-103*/
	/*firm_ide_channels,4,16-19*/
	return true;
2823
}
2824

2825
static bool arcmsr_hbaC_get_config(struct AdapterControlBlock *pACB)
2826 2827
{
	uint32_t intmask_org, Index, firmware_state = 0;
2828
	struct MessageUnit_C __iomem *reg = pACB->pmuC;
2829 2830
	char *acb_firm_model = pACB->firm_model;
	char *acb_firm_version = pACB->firm_version;
2831 2832
	char __iomem *iop_firm_model = (char __iomem *)(&reg->msgcode_rwbuffer[15]);    /*firm_model,15,60-67*/
	char __iomem *iop_firm_version = (char __iomem *)(&reg->msgcode_rwbuffer[17]);  /*firm_version,17,68-83*/
2833 2834 2835 2836 2837 2838 2839 2840 2841 2842 2843 2844 2845 2846 2847 2848 2849 2850 2851 2852 2853 2854 2855 2856 2857 2858 2859 2860 2861 2862 2863 2864 2865 2866 2867 2868 2869 2870
	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--;
	}
2871
	pr_notice("Areca RAID Controller%d: Model %s, F/W %s\n",
2872
		pACB->host->host_no,
2873 2874
		pACB->firm_model,
		pACB->firm_version);
2875 2876 2877 2878 2879 2880 2881 2882
	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;
}
2883 2884 2885 2886 2887 2888 2889 2890 2891 2892 2893 2894 2895 2896 2897 2898 2899 2900 2901 2902 2903 2904 2905 2906 2907 2908 2909 2910 2911 2912 2913 2914 2915 2916 2917 2918 2919 2920 2921 2922 2923 2924 2925 2926 2927 2928 2929 2930 2931 2932 2933 2934 2935 2936 2937 2938 2939 2940 2941 2942 2943 2944 2945 2946 2947 2948 2949 2950 2951 2952 2953 2954 2955 2956 2957 2958 2959 2960 2961 2962 2963 2964 2965 2966 2967 2968 2969 2970 2971 2972 2973 2974 2975 2976 2977 2978 2979 2980 2981 2982 2983 2984 2985 2986 2987 2988 2989 2990 2991 2992 2993 2994 2995 2996 2997 2998 2999 3000 3001 3002 3003 3004 3005 3006 3007 3008 3009 3010 3011 3012 3013

static bool arcmsr_hbaD_get_config(struct AdapterControlBlock *acb)
{
	char *acb_firm_model = acb->firm_model;
	char *acb_firm_version = acb->firm_version;
	char *acb_device_map = acb->device_map;
	char __iomem *iop_firm_model;
	char __iomem *iop_firm_version;
	char __iomem *iop_device_map;
	u32 count;
	struct MessageUnit_D *reg ;
	void *dma_coherent2;
	dma_addr_t dma_coherent_handle2;
	struct pci_dev *pdev = acb->pdev;

	acb->roundup_ccbsize = roundup(sizeof(struct MessageUnit_D), 32);
	dma_coherent2 = dma_alloc_coherent(&pdev->dev, acb->roundup_ccbsize,
		&dma_coherent_handle2, GFP_KERNEL);
	if (!dma_coherent2) {
		pr_notice("DMA allocation failed...\n");
		return false;
	}
	memset(dma_coherent2, 0, acb->roundup_ccbsize);
	acb->dma_coherent_handle2 = dma_coherent_handle2;
	acb->dma_coherent2 = dma_coherent2;
	reg = (struct MessageUnit_D *)dma_coherent2;
	acb->pmuD = reg;
	reg->chip_id = acb->mem_base0 + ARCMSR_ARC1214_CHIP_ID;
	reg->cpu_mem_config = acb->mem_base0 +
		ARCMSR_ARC1214_CPU_MEMORY_CONFIGURATION;
	reg->i2o_host_interrupt_mask = acb->mem_base0 +
		ARCMSR_ARC1214_I2_HOST_INTERRUPT_MASK;
	reg->sample_at_reset = acb->mem_base0 + ARCMSR_ARC1214_SAMPLE_RESET;
	reg->reset_request = acb->mem_base0 + ARCMSR_ARC1214_RESET_REQUEST;
	reg->host_int_status = acb->mem_base0 +
		ARCMSR_ARC1214_MAIN_INTERRUPT_STATUS;
	reg->pcief0_int_enable = acb->mem_base0 +
		ARCMSR_ARC1214_PCIE_F0_INTERRUPT_ENABLE;
	reg->inbound_msgaddr0 = acb->mem_base0 +
		ARCMSR_ARC1214_INBOUND_MESSAGE0;
	reg->inbound_msgaddr1 = acb->mem_base0 +
		ARCMSR_ARC1214_INBOUND_MESSAGE1;
	reg->outbound_msgaddr0 = acb->mem_base0 +
		ARCMSR_ARC1214_OUTBOUND_MESSAGE0;
	reg->outbound_msgaddr1 = acb->mem_base0 +
		ARCMSR_ARC1214_OUTBOUND_MESSAGE1;
	reg->inbound_doorbell = acb->mem_base0 +
		ARCMSR_ARC1214_INBOUND_DOORBELL;
	reg->outbound_doorbell = acb->mem_base0 +
		ARCMSR_ARC1214_OUTBOUND_DOORBELL;
	reg->outbound_doorbell_enable = acb->mem_base0 +
		ARCMSR_ARC1214_OUTBOUND_DOORBELL_ENABLE;
	reg->inboundlist_base_low = acb->mem_base0 +
		ARCMSR_ARC1214_INBOUND_LIST_BASE_LOW;
	reg->inboundlist_base_high = acb->mem_base0 +
		ARCMSR_ARC1214_INBOUND_LIST_BASE_HIGH;
	reg->inboundlist_write_pointer = acb->mem_base0 +
		ARCMSR_ARC1214_INBOUND_LIST_WRITE_POINTER;
	reg->outboundlist_base_low = acb->mem_base0 +
		ARCMSR_ARC1214_OUTBOUND_LIST_BASE_LOW;
	reg->outboundlist_base_high = acb->mem_base0 +
		ARCMSR_ARC1214_OUTBOUND_LIST_BASE_HIGH;
	reg->outboundlist_copy_pointer = acb->mem_base0 +
		ARCMSR_ARC1214_OUTBOUND_LIST_COPY_POINTER;
	reg->outboundlist_read_pointer = acb->mem_base0 +
		ARCMSR_ARC1214_OUTBOUND_LIST_READ_POINTER;
	reg->outboundlist_interrupt_cause = acb->mem_base0 +
		ARCMSR_ARC1214_OUTBOUND_INTERRUPT_CAUSE;
	reg->outboundlist_interrupt_enable = acb->mem_base0 +
		ARCMSR_ARC1214_OUTBOUND_INTERRUPT_ENABLE;
	reg->message_wbuffer = acb->mem_base0 + ARCMSR_ARC1214_MESSAGE_WBUFFER;
	reg->message_rbuffer = acb->mem_base0 + ARCMSR_ARC1214_MESSAGE_RBUFFER;
	reg->msgcode_rwbuffer = acb->mem_base0 +
		ARCMSR_ARC1214_MESSAGE_RWBUFFER;
	iop_firm_model = (char __iomem *)(&reg->msgcode_rwbuffer[15]);
	iop_firm_version = (char __iomem *)(&reg->msgcode_rwbuffer[17]);
	iop_device_map = (char __iomem *)(&reg->msgcode_rwbuffer[21]);
	if (readl(acb->pmuD->outbound_doorbell) &
		ARCMSR_ARC1214_IOP2DRV_MESSAGE_CMD_DONE) {
		writel(ARCMSR_ARC1214_IOP2DRV_MESSAGE_CMD_DONE,
			acb->pmuD->outbound_doorbell);/*clear interrupt*/
	}
	/* post "get config" instruction */
	writel(ARCMSR_INBOUND_MESG0_GET_CONFIG, reg->inbound_msgaddr0);
	/* wait message ready */
	if (!arcmsr_hbaD_wait_msgint_ready(acb)) {
		pr_notice("arcmsr%d: wait get adapter firmware "
			"miscellaneous data timeout\n", acb->host->host_no);
		dma_free_coherent(&acb->pdev->dev, acb->roundup_ccbsize,
			acb->dma_coherent2, acb->dma_coherent_handle2);
		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--;
	}
	count = 16;
	while (count) {
		*acb_device_map = readb(iop_device_map);
		acb_device_map++;
		iop_device_map++;
		count--;
	}
	acb->signature = readl(&reg->msgcode_rwbuffer[1]);
	/*firm_signature,1,00-03*/
	acb->firm_request_len = readl(&reg->msgcode_rwbuffer[2]);
	/*firm_request_len,1,04-07*/
	acb->firm_numbers_queue = readl(&reg->msgcode_rwbuffer[3]);
	/*firm_numbers_queue,2,08-11*/
	acb->firm_sdram_size = readl(&reg->msgcode_rwbuffer[4]);
	/*firm_sdram_size,3,12-15*/
	acb->firm_hd_channels = readl(&reg->msgcode_rwbuffer[5]);
	/*firm_hd_channels,4,16-19*/
	acb->firm_cfg_version = readl(&reg->msgcode_rwbuffer[25]);
	pr_notice("Areca RAID Controller%d: Model %s, F/W %s\n",
		acb->host->host_no,
		acb->firm_model,
		acb->firm_version);
	return true;
}

3014
static bool arcmsr_get_firmware_spec(struct AdapterControlBlock *acb)
3015
{
3016 3017 3018 3019
	bool rtn = false;

	switch (acb->adapter_type) {
	case ACB_ADAPTER_TYPE_A:
3020
		rtn = arcmsr_hbaA_get_config(acb);
3021 3022
		break;
	case ACB_ADAPTER_TYPE_B:
3023
		rtn = arcmsr_hbaB_get_config(acb);
3024 3025
		break;
	case ACB_ADAPTER_TYPE_C:
3026
		rtn = arcmsr_hbaC_get_config(acb);
3027
		break;
3028 3029 3030
	case ACB_ADAPTER_TYPE_D:
		rtn = arcmsr_hbaD_get_config(acb);
		break;
3031 3032 3033 3034 3035
	default:
		break;
	}
	if (acb->firm_numbers_queue > ARCMSR_MAX_OUTSTANDING_CMD)
		acb->maxOutstanding = ARCMSR_MAX_OUTSTANDING_CMD;
3036
	else
3037 3038 3039
		acb->maxOutstanding = acb->firm_numbers_queue - 1;
	acb->host->can_queue = acb->maxOutstanding;
	return rtn;
3040 3041
}

3042
static int arcmsr_hbaA_polling_ccbdone(struct AdapterControlBlock *acb,
3043 3044
	struct CommandControlBlock *poll_ccb)
{
A
Al Viro 已提交
3045
	struct MessageUnit_A __iomem *reg = acb->pmuA;
3046
	struct CommandControlBlock *ccb;
3047
	struct ARCMSR_CDB *arcmsr_cdb;
3048
	uint32_t flag_ccb, outbound_intstatus, poll_ccb_done = 0, poll_count = 0;
3049
	int rtn;
3050
	bool error;
3051
	polling_hba_ccb_retry:
3052
	poll_count++;
3053
	outbound_intstatus = readl(&reg->outbound_intstatus) & acb->outbound_int_enable;
3054 3055 3056
	writel(outbound_intstatus, &reg->outbound_intstatus);/*clear interrupt*/
	while (1) {
		if ((flag_ccb = readl(&reg->outbound_queueport)) == 0xFFFFFFFF) {
3057
			if (poll_ccb_done){
3058
				rtn = SUCCESS;
3059
				break;
3060 3061 3062
			}else {
				msleep(25);
				if (poll_count > 100){
3063
					rtn = FAILED;
3064
					break;
3065
				}
3066
				goto polling_hba_ccb_retry;
3067 3068
			}
		}
3069 3070
		arcmsr_cdb = (struct ARCMSR_CDB *)(acb->vir2phy_offset + (flag_ccb << 5));
		ccb = container_of(arcmsr_cdb, struct CommandControlBlock, arcmsr_cdb);
3071
		poll_ccb_done |= (ccb == poll_ccb) ? 1 : 0;
3072 3073 3074
		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'"
3075 3076 3077
					" poll command abort successfully \n"
					, acb->host->host_no
					, ccb->pcmd->device->id
H
Hannes Reinecke 已提交
3078
					, (u32)ccb->pcmd->device->lun
3079 3080
					, ccb);
				ccb->pcmd->result = DID_ABORT << 16;
3081
				arcmsr_ccb_complete(ccb);
3082 3083
				continue;
			}
3084 3085
			printk(KERN_NOTICE "arcmsr%d: polling get an illegal ccb"
				" command done ccb = '0x%p'"
3086
				"ccboutstandingcount = %d \n"
3087 3088 3089 3090
				, acb->host->host_no
				, ccb
				, atomic_read(&acb->ccboutstandingcount));
			continue;
3091 3092 3093
		}
		error = (flag_ccb & ARCMSR_CCBREPLY_FLAG_ERROR_MODE0) ? true : false;
		arcmsr_report_ccb_state(acb, ccb, error);
3094
	}
3095 3096
	return rtn;
}
3097

3098
static int arcmsr_hbaB_polling_ccbdone(struct AdapterControlBlock *acb,
3099 3100
					struct CommandControlBlock *poll_ccb)
{
3101
	struct MessageUnit_B *reg = acb->pmuB;
3102
	struct ARCMSR_CDB *arcmsr_cdb;
3103 3104
	struct CommandControlBlock *ccb;
	uint32_t flag_ccb, poll_ccb_done = 0, poll_count = 0;
3105
	int index, rtn;
3106
	bool error;
3107
	polling_hbb_ccb_retry:
3108

3109 3110
	poll_count++;
	/* clear doorbell interrupt */
3111
	writel(ARCMSR_DOORBELL_INT_CLEAR_PATTERN, reg->iop2drv_doorbell);
3112 3113
	while(1){
		index = reg->doneq_index;
3114 3115
		flag_ccb = reg->done_qbuffer[index];
		if (flag_ccb == 0) {
3116
			if (poll_ccb_done){
3117
				rtn = SUCCESS;
3118 3119 3120 3121
				break;
			}else {
				msleep(25);
				if (poll_count > 100){
3122
					rtn = FAILED;
3123
					break;
3124
				}
3125
				goto polling_hbb_ccb_retry;
3126
			}
3127
		}
3128
		reg->done_qbuffer[index] = 0;
3129 3130 3131 3132 3133
		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*/
3134 3135
		arcmsr_cdb = (struct ARCMSR_CDB *)(acb->vir2phy_offset + (flag_ccb << 5));
		ccb = container_of(arcmsr_cdb, struct CommandControlBlock, arcmsr_cdb);
3136
		poll_ccb_done |= (ccb == poll_ccb) ? 1 : 0;
3137 3138
		if ((ccb->acb != acb) || (ccb->startdone != ARCMSR_CCB_START)) {
			if ((ccb->startdone == ARCMSR_CCB_ABORTED) || (ccb == poll_ccb)) {
3139 3140
				printk(KERN_NOTICE "arcmsr%d: scsi id = %d lun = %d ccb = '0x%p'"
					" poll command abort successfully \n"
3141 3142
					,acb->host->host_no
					,ccb->pcmd->device->id
H
Hannes Reinecke 已提交
3143
					,(u32)ccb->pcmd->device->lun
3144 3145
					,ccb);
				ccb->pcmd->result = DID_ABORT << 16;
3146
				arcmsr_ccb_complete(ccb);
3147 3148 3149 3150 3151 3152 3153 3154 3155 3156 3157 3158 3159 3160 3161 3162
				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;
}

3163 3164
static int arcmsr_hbaC_polling_ccbdone(struct AdapterControlBlock *acb,
		struct CommandControlBlock *poll_ccb)
3165
{
3166
	struct MessageUnit_C __iomem *reg = acb->pmuC;
3167 3168 3169 3170 3171 3172 3173 3174 3175 3176 3177 3178 3179 3180 3181 3182 3183 3184
	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;
3185
				}
3186 3187 3188 3189 3190 3191 3192
				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);
3193
		poll_ccb_done |= (pCCB == poll_ccb) ? 1 : 0;
3194 3195 3196 3197 3198
		/* 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"
3199
					, acb->host->host_no
3200
					, pCCB->pcmd->device->id
H
Hannes Reinecke 已提交
3201
					, (u32)pCCB->pcmd->device->lun
3202 3203 3204
					, pCCB);
					pCCB->pcmd->result = DID_ABORT << 16;
					arcmsr_ccb_complete(pCCB);
3205
				continue;
3206 3207 3208 3209 3210 3211 3212 3213
			}
			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;
3214
		}
3215 3216 3217
		error = (flag_ccb & ARCMSR_CCBREPLY_FLAG_ERROR_MODE1) ? true : false;
		arcmsr_report_ccb_state(acb, pCCB, error);
	}
3218
	return rtn;
3219
}
3220 3221 3222 3223 3224 3225 3226 3227 3228 3229 3230 3231 3232 3233 3234 3235 3236 3237 3238 3239 3240 3241 3242 3243 3244 3245 3246 3247 3248 3249 3250 3251 3252 3253 3254 3255 3256 3257 3258 3259 3260 3261 3262 3263 3264 3265 3266 3267 3268 3269 3270 3271 3272 3273 3274 3275 3276 3277 3278 3279 3280 3281 3282 3283 3284 3285 3286 3287 3288 3289 3290 3291 3292 3293 3294 3295 3296 3297 3298 3299 3300 3301 3302

static int arcmsr_hbaD_polling_ccbdone(struct AdapterControlBlock *acb,
				struct CommandControlBlock *poll_ccb)
{
	bool error;
	uint32_t poll_ccb_done = 0, poll_count = 0, flag_ccb, ccb_cdb_phy;
	int rtn, doneq_index, index_stripped, outbound_write_pointer;
	unsigned long flags;
	struct ARCMSR_CDB *arcmsr_cdb;
	struct CommandControlBlock *pCCB;
	struct MessageUnit_D *pmu = acb->pmuD;

polling_hbaD_ccb_retry:
	poll_count++;
	while (1) {
		outbound_write_pointer = pmu->done_qbuffer[0].addressLow + 1;
		doneq_index = pmu->doneq_index;
		if ((outbound_write_pointer & 0xFFF) == (doneq_index & 0xFFF)) {
			if (poll_ccb_done) {
				rtn = SUCCESS;
				break;
			} else {
				msleep(25);
				if (poll_count > 40) {
					rtn = FAILED;
					break;
				}
				goto polling_hbaD_ccb_retry;
			}
		}
		spin_lock_irqsave(&acb->doneq_lock, flags);
		if (doneq_index & 0x4000) {
			index_stripped = doneq_index & 0xFFF;
			index_stripped += 1;
			index_stripped %= ARCMSR_MAX_ARC1214_DONEQUEUE;
			pmu->doneq_index = index_stripped ?
				(index_stripped | 0x4000) :
				(index_stripped + 1);
		} else {
			index_stripped = doneq_index;
			index_stripped += 1;
			index_stripped %= ARCMSR_MAX_ARC1214_DONEQUEUE;
			pmu->doneq_index = index_stripped ? index_stripped :
				((index_stripped | 0x4000) + 1);
		}
		spin_unlock_irqrestore(&acb->doneq_lock, flags);
		doneq_index = pmu->doneq_index;
		flag_ccb = pmu->done_qbuffer[doneq_index & 0xFFF].addressLow;
		ccb_cdb_phy = (flag_ccb & 0xFFFFFFF0);
		arcmsr_cdb = (struct ARCMSR_CDB *)(acb->vir2phy_offset +
			ccb_cdb_phy);
		pCCB = container_of(arcmsr_cdb, struct CommandControlBlock,
			arcmsr_cdb);
		poll_ccb_done |= (pCCB == poll_ccb) ? 1 : 0;
		if ((pCCB->acb != acb) ||
			(pCCB->startdone != ARCMSR_CCB_START)) {
			if (pCCB->startdone == ARCMSR_CCB_ABORTED) {
				pr_notice("arcmsr%d: scsi id = %d "
					"lun = %d ccb = '0x%p' poll command "
					"abort successfully\n"
					, acb->host->host_no
					, pCCB->pcmd->device->id
					, (u32)pCCB->pcmd->device->lun
					, pCCB);
				pCCB->pcmd->result = DID_ABORT << 16;
				arcmsr_ccb_complete(pCCB);
				continue;
			}
			pr_notice("arcmsr%d: polling an illegal "
				"ccb command done ccb = '0x%p' "
				"ccboutstandingcount = %d\n"
				, acb->host->host_no
				, pCCB
				, atomic_read(&acb->ccboutstandingcount));
			continue;
		}
		error = (flag_ccb & ARCMSR_CCBREPLY_FLAG_ERROR_MODE1)
			? true : false;
		arcmsr_report_ccb_state(acb, pCCB, error);
	}
	return rtn;
}

3303
static int arcmsr_polling_ccbdone(struct AdapterControlBlock *acb,
3304 3305
					struct CommandControlBlock *poll_ccb)
{
3306
	int rtn = 0;
3307 3308 3309
	switch (acb->adapter_type) {

	case ACB_ADAPTER_TYPE_A: {
3310
		rtn = arcmsr_hbaA_polling_ccbdone(acb, poll_ccb);
3311 3312 3313 3314
		}
		break;

	case ACB_ADAPTER_TYPE_B: {
3315
		rtn = arcmsr_hbaB_polling_ccbdone(acb, poll_ccb);
3316
		}
3317 3318
		break;
	case ACB_ADAPTER_TYPE_C: {
3319
		rtn = arcmsr_hbaC_polling_ccbdone(acb, poll_ccb);
3320
		}
3321 3322 3323 3324
		break;
	case ACB_ADAPTER_TYPE_D:
		rtn = arcmsr_hbaD_polling_ccbdone(acb, poll_ccb);
		break;
3325
	}
3326
	return rtn;
3327
}
3328 3329

static int arcmsr_iop_confirm(struct AdapterControlBlock *acb)
3330
{
3331
	uint32_t cdb_phyaddr, cdb_phyaddr_hi32;
3332
	dma_addr_t dma_coherent_handle;
3333

3334 3335 3336 3337 3338 3339
	/*
	********************************************************************
	** here we need to tell iop 331 our freeccb.HighPart
	** if freeccb.HighPart is not zero
	********************************************************************
	*/
3340 3341
	switch (acb->adapter_type) {
	case ACB_ADAPTER_TYPE_B:
3342
	case ACB_ADAPTER_TYPE_D:
3343 3344 3345 3346 3347 3348 3349 3350
		dma_coherent_handle = acb->dma_coherent_handle2;
		break;
	default:
		dma_coherent_handle = acb->dma_coherent_handle;
		break;
	}
	cdb_phyaddr = lower_32_bits(dma_coherent_handle);
	cdb_phyaddr_hi32 = upper_32_bits(dma_coherent_handle);
3351
	acb->cdb_phyaddr_hi32 = cdb_phyaddr_hi32;
3352 3353 3354 3355 3356 3357 3358 3359
	/*
	***********************************************************************
	**    if adapter type B, set window of "post command Q"
	***********************************************************************
	*/
	switch (acb->adapter_type) {

	case ACB_ADAPTER_TYPE_A: {
3360
		if (cdb_phyaddr_hi32 != 0) {
A
Al Viro 已提交
3361
			struct MessageUnit_A __iomem *reg = acb->pmuA;
3362 3363
			writel(ARCMSR_SIGNATURE_SET_CONFIG, \
						&reg->message_rwbuffer[0]);
3364
			writel(cdb_phyaddr_hi32, &reg->message_rwbuffer[1]);
3365 3366
			writel(ARCMSR_INBOUND_MESG0_SET_CONFIG, \
							&reg->inbound_msgaddr0);
3367
			if (!arcmsr_hbaA_wait_msgint_ready(acb)) {
3368 3369 3370 3371
				printk(KERN_NOTICE "arcmsr%d: ""set ccb high \
				part physical address timeout\n",
				acb->host->host_no);
				return 1;
3372
			}
3373 3374 3375
		}
		}
		break;
3376

3377
	case ACB_ADAPTER_TYPE_B: {
A
Al Viro 已提交
3378
		uint32_t __iomem *rwbuffer;
3379

A
Al Viro 已提交
3380
		struct MessageUnit_B *reg = acb->pmuB;
3381 3382
		reg->postq_index = 0;
		reg->doneq_index = 0;
3383
		writel(ARCMSR_MESSAGE_SET_POST_WINDOW, reg->drv2iop_doorbell);
3384
		if (!arcmsr_hbaB_wait_msgint_ready(acb)) {
3385 3386 3387 3388
			printk(KERN_NOTICE "arcmsr%d:can not set diver mode\n", \
				acb->host->host_no);
			return 1;
		}
3389
		rwbuffer = reg->message_rwbuffer;
3390 3391 3392
		/* driver "set config" signature */
		writel(ARCMSR_SIGNATURE_SET_CONFIG, rwbuffer++);
		/* normal should be zero */
3393
		writel(cdb_phyaddr_hi32, rwbuffer++);
3394
		/* postQ size (256 + 8)*4	 */
3395
		writel(cdb_phyaddr, rwbuffer++);
3396
		/* doneQ size (256 + 8)*4	 */
3397
		writel(cdb_phyaddr + 1056, rwbuffer++);
3398 3399 3400
		/* ccb maxQ size must be --> [(256 + 8)*4]*/
		writel(1056, rwbuffer);

3401
		writel(ARCMSR_MESSAGE_SET_CONFIG, reg->drv2iop_doorbell);
3402
		if (!arcmsr_hbaB_wait_msgint_ready(acb)) {
3403 3404 3405 3406
			printk(KERN_NOTICE "arcmsr%d: 'set command Q window' \
			timeout \n",acb->host->host_no);
			return 1;
		}
3407
		writel(ARCMSR_MESSAGE_START_DRIVER_MODE, reg->drv2iop_doorbell);
3408
		if (!arcmsr_hbaB_wait_msgint_ready(acb)) {
3409 3410 3411 3412
			pr_err("arcmsr%d: can't set driver mode.\n",
				acb->host->host_no);
			return 1;
		}
3413 3414
		}
		break;
3415 3416
	case ACB_ADAPTER_TYPE_C: {
		if (cdb_phyaddr_hi32 != 0) {
3417
			struct MessageUnit_C __iomem *reg = acb->pmuC;
3418

3419 3420
			printk(KERN_NOTICE "arcmsr%d: cdb_phyaddr_hi32=0x%x\n",
					acb->adapter_index, cdb_phyaddr_hi32);
3421 3422 3423 3424
			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);
3425
			if (!arcmsr_hbaC_wait_msgint_ready(acb)) {
3426 3427 3428 3429 3430 3431
				printk(KERN_NOTICE "arcmsr%d: 'set command Q window' \
				timeout \n", acb->host->host_no);
				return 1;
			}
		}
		}
3432 3433 3434 3435 3436 3437 3438 3439 3440 3441 3442 3443 3444 3445 3446 3447 3448 3449 3450 3451 3452
		break;
	case ACB_ADAPTER_TYPE_D: {
		uint32_t __iomem *rwbuffer;
		struct MessageUnit_D *reg = acb->pmuD;
		reg->postq_index = 0;
		reg->doneq_index = 0;
		rwbuffer = reg->msgcode_rwbuffer;
		writel(ARCMSR_SIGNATURE_SET_CONFIG, rwbuffer++);
		writel(cdb_phyaddr_hi32, rwbuffer++);
		writel(cdb_phyaddr, rwbuffer++);
		writel(cdb_phyaddr + (ARCMSR_MAX_ARC1214_POSTQUEUE *
			sizeof(struct InBound_SRB)), rwbuffer++);
		writel(0x100, rwbuffer);
		writel(ARCMSR_INBOUND_MESG0_SET_CONFIG, reg->inbound_msgaddr0);
		if (!arcmsr_hbaD_wait_msgint_ready(acb)) {
			pr_notice("arcmsr%d: 'set command Q window' timeout\n",
				acb->host->host_no);
			return 1;
		}
		}
		break;
3453 3454 3455
	}
	return 0;
}
3456

3457 3458 3459 3460 3461 3462
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 已提交
3463
		struct MessageUnit_A __iomem *reg = acb->pmuA;
3464 3465 3466 3467 3468 3469 3470
		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 已提交
3471
		struct MessageUnit_B *reg = acb->pmuB;
3472
		do {
3473
			firmware_state = readl(reg->iop2drv_doorbell);
3474
		} while ((firmware_state & ARCMSR_MESSAGE_FIRMWARE_OK) == 0);
3475
		writel(ARCMSR_DRV2IOP_END_OF_INTERRUPT, reg->drv2iop_doorbell);
3476 3477
		}
		break;
3478
	case ACB_ADAPTER_TYPE_C: {
3479
		struct MessageUnit_C __iomem *reg = acb->pmuC;
3480 3481 3482 3483
		do {
			firmware_state = readl(&reg->outbound_msgaddr1);
		} while ((firmware_state & ARCMSR_HBCMU_MESSAGE_FIRMWARE_OK) == 0);
		}
3484 3485 3486 3487 3488 3489 3490 3491 3492
		break;
	case ACB_ADAPTER_TYPE_D: {
		struct MessageUnit_D *reg = acb->pmuD;
		do {
			firmware_state = readl(reg->outbound_msgaddr1);
		} while ((firmware_state &
			ARCMSR_ARC1214_MESSAGE_FIRMWARE_OK) == 0);
		}
		break;
3493
	}
3494 3495
}

3496
static void arcmsr_hbaA_request_device_map(struct AdapterControlBlock *acb)
3497 3498
{
	struct MessageUnit_A __iomem *reg = acb->pmuA;
3499
	if (unlikely(atomic_read(&acb->rq_map_token) == 0) || ((acb->acb_flags & ACB_F_BUS_RESET) != 0 ) || ((acb->acb_flags & ACB_F_ABORT) != 0 )){
3500
		mod_timer(&acb->eternal_timer, jiffies + msecs_to_jiffies(6 * HZ));
3501
		return;
3502
	} else {
3503
		acb->fw_flag = FW_NORMAL;
3504
		if (atomic_read(&acb->ante_token_value) == atomic_read(&acb->rq_map_token)){
3505 3506
			atomic_set(&acb->rq_map_token, 16);
		}
3507
		atomic_set(&acb->ante_token_value, atomic_read(&acb->rq_map_token));
3508 3509
		if (atomic_dec_and_test(&acb->rq_map_token)) {
			mod_timer(&acb->eternal_timer, jiffies + msecs_to_jiffies(6 * HZ));
3510
			return;
3511
		}
3512
		writel(ARCMSR_INBOUND_MESG0_GET_CONFIG, &reg->inbound_msgaddr0);
3513
		mod_timer(&acb->eternal_timer, jiffies + msecs_to_jiffies(6 * HZ));
3514 3515 3516 3517
	}
	return;
}

3518
static void arcmsr_hbaB_request_device_map(struct AdapterControlBlock *acb)
3519
{
3520
	struct MessageUnit_B *reg = acb->pmuB;
3521
	if (unlikely(atomic_read(&acb->rq_map_token) == 0) || ((acb->acb_flags & ACB_F_BUS_RESET) != 0 ) || ((acb->acb_flags & ACB_F_ABORT) != 0 )){
3522
		mod_timer(&acb->eternal_timer, jiffies + msecs_to_jiffies(6 * HZ));
3523 3524 3525 3526
		return;
	} else {
		acb->fw_flag = FW_NORMAL;
		if (atomic_read(&acb->ante_token_value) == atomic_read(&acb->rq_map_token)) {
3527
			atomic_set(&acb->rq_map_token, 16);
3528 3529
		}
		atomic_set(&acb->ante_token_value, atomic_read(&acb->rq_map_token));
3530 3531
		if (atomic_dec_and_test(&acb->rq_map_token)) {
			mod_timer(&acb->eternal_timer, jiffies + msecs_to_jiffies(6 * HZ));
3532
			return;
3533
		}
3534 3535 3536 3537 3538
		writel(ARCMSR_MESSAGE_GET_CONFIG, reg->drv2iop_doorbell);
		mod_timer(&acb->eternal_timer, jiffies + msecs_to_jiffies(6 * HZ));
	}
	return;
}
3539

3540
static void arcmsr_hbaC_request_device_map(struct AdapterControlBlock *acb)
3541 3542
{
	struct MessageUnit_C __iomem *reg = acb->pmuC;
3543
	if (unlikely(atomic_read(&acb->rq_map_token) == 0) || ((acb->acb_flags & ACB_F_BUS_RESET) != 0) || ((acb->acb_flags & ACB_F_ABORT) != 0)) {
3544
		mod_timer(&acb->eternal_timer, jiffies + msecs_to_jiffies(6 * HZ));
3545
		return;
3546
	} else {
3547 3548
		acb->fw_flag = FW_NORMAL;
		if (atomic_read(&acb->ante_token_value) == atomic_read(&acb->rq_map_token)) {
3549 3550
			atomic_set(&acb->rq_map_token, 16);
		}
3551
		atomic_set(&acb->ante_token_value, atomic_read(&acb->rq_map_token));
3552 3553
		if (atomic_dec_and_test(&acb->rq_map_token)) {
			mod_timer(&acb->eternal_timer, jiffies + msecs_to_jiffies(6 * HZ));
3554
			return;
3555
		}
3556 3557 3558
		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));
3559 3560 3561 3562
	}
	return;
}

3563 3564 3565 3566 3567 3568 3569 3570 3571 3572 3573 3574 3575 3576 3577 3578 3579 3580 3581 3582 3583 3584 3585 3586 3587 3588 3589 3590 3591
static void arcmsr_hbaD_request_device_map(struct AdapterControlBlock *acb)
{
	struct MessageUnit_D *reg = acb->pmuD;

	if (unlikely(atomic_read(&acb->rq_map_token) == 0) ||
		((acb->acb_flags & ACB_F_BUS_RESET) != 0) ||
		((acb->acb_flags & ACB_F_ABORT) != 0)) {
		mod_timer(&acb->eternal_timer,
			jiffies + msecs_to_jiffies(6 * HZ));
	} else {
		acb->fw_flag = FW_NORMAL;
		if (atomic_read(&acb->ante_token_value) ==
			atomic_read(&acb->rq_map_token)) {
			atomic_set(&acb->rq_map_token, 16);
		}
		atomic_set(&acb->ante_token_value,
			atomic_read(&acb->rq_map_token));
		if (atomic_dec_and_test(&acb->rq_map_token)) {
			mod_timer(&acb->eternal_timer, jiffies +
				msecs_to_jiffies(6 * HZ));
			return;
		}
		writel(ARCMSR_INBOUND_MESG0_GET_CONFIG,
			reg->inbound_msgaddr0);
		mod_timer(&acb->eternal_timer, jiffies +
			msecs_to_jiffies(6 * HZ));
	}
}

3592 3593 3594 3595 3596
static void arcmsr_request_device_map(unsigned long pacb)
{
	struct AdapterControlBlock *acb = (struct AdapterControlBlock *)pacb;
	switch (acb->adapter_type) {
		case ACB_ADAPTER_TYPE_A: {
3597
			arcmsr_hbaA_request_device_map(acb);
3598 3599 3600
		}
		break;
		case ACB_ADAPTER_TYPE_B: {
3601
			arcmsr_hbaB_request_device_map(acb);
3602 3603
		}
		break;
3604
		case ACB_ADAPTER_TYPE_C: {
3605
			arcmsr_hbaC_request_device_map(acb);
3606
		}
3607 3608 3609 3610
		break;
		case ACB_ADAPTER_TYPE_D:
			arcmsr_hbaD_request_device_map(acb);
		break;
3611 3612 3613
	}
}

3614
static void arcmsr_hbaA_start_bgrb(struct AdapterControlBlock *acb)
3615
{
A
Al Viro 已提交
3616
	struct MessageUnit_A __iomem *reg = acb->pmuA;
3617 3618
	acb->acb_flags |= ACB_F_MSG_START_BGRB;
	writel(ARCMSR_INBOUND_MESG0_START_BGRB, &reg->inbound_msgaddr0);
3619
	if (!arcmsr_hbaA_wait_msgint_ready(acb)) {
3620 3621
		printk(KERN_NOTICE "arcmsr%d: wait 'start adapter background \
				rebulid' timeout \n", acb->host->host_no);
3622 3623 3624
	}
}

3625
static void arcmsr_hbaB_start_bgrb(struct AdapterControlBlock *acb)
3626
{
A
Al Viro 已提交
3627
	struct MessageUnit_B *reg = acb->pmuB;
3628
	acb->acb_flags |= ACB_F_MSG_START_BGRB;
3629
	writel(ARCMSR_MESSAGE_START_BGRB, reg->drv2iop_doorbell);
3630
	if (!arcmsr_hbaB_wait_msgint_ready(acb)) {
3631 3632 3633 3634
		printk(KERN_NOTICE "arcmsr%d: wait 'start adapter background \
				rebulid' timeout \n",acb->host->host_no);
	}
}
3635

3636
static void arcmsr_hbaC_start_bgrb(struct AdapterControlBlock *pACB)
3637
{
3638
	struct MessageUnit_C __iomem *phbcmu = pACB->pmuC;
3639 3640 3641
	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);
3642
	if (!arcmsr_hbaC_wait_msgint_ready(pACB)) {
3643 3644 3645 3646 3647
		printk(KERN_NOTICE "arcmsr%d: wait 'start adapter background \
				rebulid' timeout \n", pACB->host->host_no);
	}
	return;
}
3648 3649 3650 3651 3652 3653 3654 3655 3656 3657 3658 3659 3660

static void arcmsr_hbaD_start_bgrb(struct AdapterControlBlock *pACB)
{
	struct MessageUnit_D *pmu = pACB->pmuD;

	pACB->acb_flags |= ACB_F_MSG_START_BGRB;
	writel(ARCMSR_INBOUND_MESG0_START_BGRB, pmu->inbound_msgaddr0);
	if (!arcmsr_hbaD_wait_msgint_ready(pACB)) {
		pr_notice("arcmsr%d: wait 'start adapter "
			"background rebulid' timeout\n", pACB->host->host_no);
	}
}

3661
static void arcmsr_start_adapter_bgrb(struct AdapterControlBlock *acb)
3662
{
3663 3664
	switch (acb->adapter_type) {
	case ACB_ADAPTER_TYPE_A:
3665
		arcmsr_hbaA_start_bgrb(acb);
3666 3667
		break;
	case ACB_ADAPTER_TYPE_B:
3668
		arcmsr_hbaB_start_bgrb(acb);
3669
		break;
3670
	case ACB_ADAPTER_TYPE_C:
3671
		arcmsr_hbaC_start_bgrb(acb);
3672 3673 3674 3675
		break;
	case ACB_ADAPTER_TYPE_D:
		arcmsr_hbaD_start_bgrb(acb);
		break;
3676 3677
	}
}
3678

3679 3680 3681 3682
static void arcmsr_clear_doorbell_queue_buffer(struct AdapterControlBlock *acb)
{
	switch (acb->adapter_type) {
	case ACB_ADAPTER_TYPE_A: {
A
Al Viro 已提交
3683
		struct MessageUnit_A __iomem *reg = acb->pmuA;
3684 3685 3686 3687 3688 3689 3690 3691
		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;
3692

3693
	case ACB_ADAPTER_TYPE_B: {
A
Al Viro 已提交
3694
		struct MessageUnit_B *reg = acb->pmuB;
3695
		/*clear interrupt and message state*/
3696 3697
		writel(ARCMSR_MESSAGE_INT_CLEAR_PATTERN, reg->iop2drv_doorbell);
		writel(ARCMSR_DRV2IOP_DATA_READ_OK, reg->drv2iop_doorbell);
3698 3699 3700
		/* let IOP know data has been read */
		}
		break;
3701
	case ACB_ADAPTER_TYPE_C: {
3702
		struct MessageUnit_C __iomem *reg = acb->pmuC;
3703
		uint32_t outbound_doorbell, i;
3704 3705 3706 3707
		/* 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);
3708 3709 3710 3711 3712 3713 3714 3715 3716 3717 3718 3719
		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;
		}
3720
		}
3721 3722 3723 3724 3725 3726 3727 3728 3729 3730 3731 3732 3733 3734 3735 3736 3737 3738 3739 3740 3741 3742 3743
		break;
	case ACB_ADAPTER_TYPE_D: {
		struct MessageUnit_D *reg = acb->pmuD;
		uint32_t outbound_doorbell, i;
		/* empty doorbell Qbuffer if door bell ringed */
		outbound_doorbell = readl(reg->outbound_doorbell);
		writel(outbound_doorbell, reg->outbound_doorbell);
		writel(ARCMSR_ARC1214_DRV2IOP_DATA_OUT_READ,
			reg->inbound_doorbell);
		for (i = 0; i < 200; i++) {
			msleep(20);
			outbound_doorbell = readl(reg->outbound_doorbell);
			if (outbound_doorbell &
				ARCMSR_ARC1214_IOP2DRV_DATA_WRITE_OK) {
				writel(outbound_doorbell,
					reg->outbound_doorbell);
				writel(ARCMSR_ARC1214_DRV2IOP_DATA_OUT_READ,
					reg->inbound_doorbell);
			} else
				break;
		}
		}
		break;
3744
	}
3745
}
3746

N
Nick Cheng 已提交
3747 3748 3749 3750 3751 3752 3753 3754
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;
3755
			writel(ARCMSR_MESSAGE_ACTIVE_EOI_MODE, reg->drv2iop_doorbell);
3756
			if (!arcmsr_hbaB_wait_msgint_ready(acb)) {
N
Nick Cheng 已提交
3757 3758 3759 3760 3761
				printk(KERN_NOTICE "ARCMSR IOP enables EOI_MODE TIMEOUT");
				return;
			}
		}
		break;
3762 3763
	case ACB_ADAPTER_TYPE_C:
		return;
N
Nick Cheng 已提交
3764 3765 3766 3767
	}
	return;
}

3768 3769 3770
static void arcmsr_hardware_reset(struct AdapterControlBlock *acb)
{
	uint8_t value[64];
3771 3772 3773
	int i, count = 0;
	struct MessageUnit_A __iomem *pmuA = acb->pmuA;
	struct MessageUnit_C __iomem *pmuC = acb->pmuC;
3774
	struct MessageUnit_D *pmuD = acb->pmuD;
3775

3776
	/* backup pci config data */
3777
	printk(KERN_NOTICE "arcmsr%d: executing hw bus reset .....\n", acb->host->host_no);
3778 3779 3780 3781
	for (i = 0; i < 64; i++) {
		pci_read_config_byte(acb->pdev, i, &value[i]);
	}
	/* hardware reset signal */
3782
	if ((acb->dev_id == 0x1680)) {
3783 3784 3785 3786 3787 3788 3789 3790 3791 3792
		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);
3793
		} while (((readl(&pmuC->host_diagnostic) & ARCMSR_ARC1880_DiagWrite_ENABLE) == 0) && (count < 5));
3794
		writel(ARCMSR_ARC1880_RESET_ADAPTER, &pmuC->host_diagnostic);
3795 3796
	} else if ((acb->dev_id == 0x1214)) {
		writel(0x20, pmuD->reset_request);
3797
	} else {
3798
		pci_write_config_byte(acb->pdev, 0x84, 0x20);
3799
	}
3800
	msleep(2000);
3801 3802 3803 3804 3805 3806 3807
	/* write back pci config data */
	for (i = 0; i < 64; i++) {
		pci_write_config_byte(acb->pdev, i, value[i]);
	}
	msleep(1000);
	return;
}
3808 3809 3810
static void arcmsr_iop_init(struct AdapterControlBlock *acb)
{
	uint32_t intmask_org;
3811 3812
	/* disable all outbound interrupt */
	intmask_org = arcmsr_disable_outbound_ints(acb);
N
Nick Cheng 已提交
3813 3814
	arcmsr_wait_firmware_ready(acb);
	arcmsr_iop_confirm(acb);
3815 3816 3817 3818
	/*start background rebuild*/
	arcmsr_start_adapter_bgrb(acb);
	/* empty doorbell Qbuffer if door bell ringed */
	arcmsr_clear_doorbell_queue_buffer(acb);
N
Nick Cheng 已提交
3819
	arcmsr_enable_eoi_mode(acb);
3820 3821
	/* enable outbound Post Queue,outbound doorbell Interrupt */
	arcmsr_enable_outbound_ints(acb, intmask_org);
3822 3823 3824
	acb->acb_flags |= ACB_F_IOP_INITED;
}

3825
static uint8_t arcmsr_iop_reset(struct AdapterControlBlock *acb)
3826 3827 3828
{
	struct CommandControlBlock *ccb;
	uint32_t intmask_org;
3829
	uint8_t rtnval = 0x00;
3830
	int i = 0;
3831 3832
	unsigned long flags;

3833
	if (atomic_read(&acb->ccboutstandingcount) != 0) {
3834 3835
		/* disable all outbound interrupt */
		intmask_org = arcmsr_disable_outbound_ints(acb);
3836
		/* talk to iop 331 outstanding command aborted */
3837
		rtnval = arcmsr_abort_allcmd(acb);
3838
		/* clear all outbound posted Q */
3839
		arcmsr_done4abort_postqueue(acb);
3840 3841
		for (i = 0; i < ARCMSR_MAX_FREECCB_NUM; i++) {
			ccb = acb->pccb_pool[i];
3842
			if (ccb->startdone == ARCMSR_CCB_START) {
3843 3844 3845 3846 3847 3848
				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);
3849 3850
			}
		}
3851
		atomic_set(&acb->ccboutstandingcount, 0);
3852 3853
		/* enable all outbound interrupt */
		arcmsr_enable_outbound_ints(acb, intmask_org);
3854
		return rtnval;
3855
	}
3856
	return rtnval;
3857 3858 3859 3860
}

static int arcmsr_bus_reset(struct scsi_cmnd *cmd)
{
3861
	struct AdapterControlBlock *acb;
3862 3863 3864 3865
	uint32_t intmask_org, outbound_doorbell;
	int retry_count = 0;
	int rtn = FAILED;
	acb = (struct AdapterControlBlock *) cmd->device->host->hostdata;
3866
	printk(KERN_ERR "arcmsr: executing bus reset eh.....num_resets = %d, num_aborts = %d \n", acb->num_resets, acb->num_aborts);
3867 3868
	acb->num_resets++;

3869 3870 3871
	switch(acb->adapter_type){
		case ACB_ADAPTER_TYPE_A:{
			if (acb->acb_flags & ACB_F_BUS_RESET){
3872
				long timeout;
3873 3874
				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);
3875 3876 3877 3878 3879
				if (timeout) {
					return SUCCESS;
				}
			}
			acb->acb_flags |= ACB_F_BUS_RESET;
3880
			if (!arcmsr_iop_reset(acb)) {
3881 3882
				struct MessageUnit_A __iomem *reg;
				reg = acb->pmuA;
3883 3884
				arcmsr_hardware_reset(acb);
				acb->acb_flags &= ~ACB_F_IOP_INITED;
3885
sleep_again:
3886
				ssleep(ARCMSR_SLEEPTIME);
3887
				if ((readl(&reg->outbound_msgaddr1) & ARCMSR_OUTBOUND_MESG1_FIRMWARE_OK) == 0) {
3888 3889
					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) {
3890
						acb->fw_flag = FW_DEADLOCK;
3891
						printk(KERN_ERR "arcmsr%d: waiting for hw bus reset return, RETRY TERMINATED!!\n", acb->host->host_no);
3892
						return FAILED;
3893 3894 3895 3896 3897 3898 3899
					}
					retry_count++;
					goto sleep_again;
				}
				acb->acb_flags |= ACB_F_IOP_INITED;
				/* disable all outbound interrupt */
				intmask_org = arcmsr_disable_outbound_ints(acb);
3900
				arcmsr_get_firmware_spec(acb);
3901 3902 3903 3904 3905 3906 3907 3908
				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);
3909 3910
				atomic_set(&acb->ante_token_value, 16);
				acb->fw_flag = FW_NORMAL;
3911
				mod_timer(&acb->eternal_timer, jiffies + msecs_to_jiffies(6 * HZ));
3912 3913
				acb->acb_flags &= ~ACB_F_BUS_RESET;
				rtn = SUCCESS;
3914
				printk(KERN_ERR "arcmsr: scsi  bus reset eh returns with success\n");
3915 3916
			} else {
				acb->acb_flags &= ~ACB_F_BUS_RESET;
3917 3918 3919 3920
				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));
3921
				rtn = SUCCESS;
3922
			}
3923
			break;
3924
		}
3925 3926
		case ACB_ADAPTER_TYPE_B:{
			acb->acb_flags |= ACB_F_BUS_RESET;
3927
			if (!arcmsr_iop_reset(acb)) {
3928 3929
				acb->acb_flags &= ~ACB_F_BUS_RESET;
				rtn = FAILED;
3930 3931
			} else {
				acb->acb_flags &= ~ACB_F_BUS_RESET;
3932 3933 3934 3935
				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));
3936
				rtn = SUCCESS;
3937 3938 3939 3940 3941 3942 3943 3944 3945 3946 3947 3948 3949 3950 3951 3952 3953 3954 3955
			}
			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:
3956
				ssleep(ARCMSR_SLEEPTIME);
3957
				if ((readl(&reg->host_diagnostic) & 0x04) != 0) {
3958 3959
					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) {
3960
						acb->fw_flag = FW_DEADLOCK;
3961
						printk(KERN_ERR "arcmsr%d: waiting for hw bus reset return, RETRY TERMINATED!!\n", acb->host->host_no);
3962 3963 3964 3965 3966 3967 3968 3969 3970 3971 3972
						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 */
3973
				arcmsr_clear_doorbell_queue_buffer(acb);
3974 3975 3976 3977 3978
				/* 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;
3979
				mod_timer(&acb->eternal_timer, jiffies + msecs_to_jiffies(6 * HZ));
3980 3981 3982 3983 3984
				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;
3985 3986 3987 3988
				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));
3989 3990 3991
				rtn = SUCCESS;
			}
			break;
3992
		}
3993 3994 3995 3996 3997 3998 3999 4000 4001 4002 4003 4004 4005 4006 4007 4008 4009 4010 4011 4012 4013 4014 4015 4016 4017 4018 4019 4020 4021 4022 4023 4024 4025 4026 4027 4028 4029 4030 4031 4032 4033 4034 4035 4036 4037 4038 4039 4040 4041 4042 4043 4044 4045 4046 4047 4048 4049 4050 4051 4052
		case ACB_ADAPTER_TYPE_D: {
			if (acb->acb_flags & ACB_F_BUS_RESET) {
				long timeout;
				pr_notice("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_D *reg;
				reg = acb->pmuD;
				arcmsr_hardware_reset(acb);
				acb->acb_flags &= ~ACB_F_IOP_INITED;
			nap:
				ssleep(ARCMSR_SLEEPTIME);
				if ((readl(reg->sample_at_reset) & 0x80) != 0) {
					pr_err("arcmsr%d: waiting for "
						"hw bus reset return, retry=%d\n",
						acb->host->host_no, retry_count);
					if (retry_count > ARCMSR_RETRYCOUNT) {
						acb->fw_flag = FW_DEADLOCK;
						pr_err("arcmsr%d: waiting for hw bus"
							" reset return, "
							"RETRY TERMINATED!!\n",
							acb->host->host_no);
						return FAILED;
					}
					retry_count++;
					goto nap;
				}
				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);
				arcmsr_clear_doorbell_queue_buffer(acb);
				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;
				mod_timer(&acb->eternal_timer,
					jiffies + msecs_to_jiffies(6 * HZ));
				acb->acb_flags &= ~ACB_F_BUS_RESET;
				rtn = SUCCESS;
				pr_err("arcmsr: scsi bus reset "
					"eh returns with success\n");
			} else {
				acb->acb_flags &= ~ACB_F_BUS_RESET;
				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));
				rtn = SUCCESS;
			}
			break;
		}
4053 4054
	}
	return rtn;
4055 4056
}

4057
static int arcmsr_abort_one_cmd(struct AdapterControlBlock *acb,
4058 4059
		struct CommandControlBlock *ccb)
{
4060 4061 4062
	int rtn;
	rtn = arcmsr_polling_ccbdone(acb, ccb);
	return rtn;
4063 4064 4065 4066 4067 4068 4069
}

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

4073
	printk(KERN_NOTICE
4074
		"arcmsr%d: abort device command of scsi id = %d lun = %d\n",
H
Hannes Reinecke 已提交
4075
		acb->host->host_no, cmd->device->id, (u32)cmd->device->lun);
4076
	acb->acb_flags |= ACB_F_ABORT;
4077 4078 4079 4080 4081 4082 4083
	acb->num_aborts++;
	/*
	************************************************
	** the all interrupt service routine is locked
	** we need to handle it as soon as possible and exit
	************************************************
	*/
4084 4085
	if (!atomic_read(&acb->ccboutstandingcount)) {
		acb->acb_flags &= ~ACB_F_ABORT;
4086
		return rtn;
4087
	}
4088

4089
	intmask_org = arcmsr_disable_outbound_ints(acb);
4090 4091 4092
	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) {
4093 4094
			ccb->startdone = ARCMSR_CCB_ABORTED;
			rtn = arcmsr_abort_one_cmd(acb, ccb);
4095 4096 4097
			break;
		}
	}
4098
	acb->acb_flags &= ~ACB_F_ABORT;
4099
	arcmsr_enable_outbound_ints(acb, intmask_org);
4100
	return rtn;
4101 4102 4103 4104 4105 4106 4107 4108 4109 4110 4111
}

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:
4112 4113
	case PCI_DEVICE_ID_ARECA_1200:
	case PCI_DEVICE_ID_ARECA_1202:
4114 4115 4116 4117 4118 4119 4120
	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:
4121
	case PCI_DEVICE_ID_ARECA_1201:
4122 4123 4124 4125 4126 4127 4128
	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;
4129
	case PCI_DEVICE_ID_ARECA_1214:
4130 4131 4132 4133
	case PCI_DEVICE_ID_ARECA_1380:
	case PCI_DEVICE_ID_ARECA_1381:
	case PCI_DEVICE_ID_ARECA_1680:
	case PCI_DEVICE_ID_ARECA_1681:
4134
	case PCI_DEVICE_ID_ARECA_1880:
4135
		type = "SAS/SATA";
4136 4137
		break;
	default:
4138 4139
		type = "unknown";
		raid6 =	0;
4140 4141
		break;
	}
4142 4143
	sprintf(buf, "Areca %s RAID Controller %s\narcmsr version %s\n",
		type, raid6 ? "(RAID6 capable)" : "", ARCMSR_DRIVER_VERSION);
4144 4145
	return buf;
}