cciss.c 95.3 KB
Newer Older
L
Linus Torvalds 已提交
1 2
/*
 *    Disk Array driver for HP SA 5xxx and 6xxx Controllers
3
 *    Copyright 2000, 2006 Hewlett-Packard Development Company, L.P.
L
Linus Torvalds 已提交
4 5 6 7 8 9 10 11 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
 *
 *    This program is free software; you can redistribute it and/or modify
 *    it under the terms of the GNU General Public License as published by
 *    the Free Software Foundation; either version 2 of the License, or
 *    (at your option) any later version.
 *
 *    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, GOOD TITLE or
 *    NON INFRINGEMENT.  See the GNU General Public License for more details.
 *
 *    You should have received a copy of the GNU General Public License
 *    along with this program; if not, write to the Free Software
 *    Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
 *
 *    Questions/Comments/Bugfixes to iss_storagedev@hp.com
 *
 */

#include <linux/config.h>	/* CONFIG_PROC_FS */
#include <linux/module.h>
#include <linux/interrupt.h>
#include <linux/types.h>
#include <linux/pci.h>
#include <linux/kernel.h>
#include <linux/slab.h>
#include <linux/delay.h>
#include <linux/major.h>
#include <linux/fs.h>
#include <linux/bio.h>
#include <linux/blkpg.h>
#include <linux/timer.h>
#include <linux/proc_fs.h>
37
#include <linux/init.h>
L
Linus Torvalds 已提交
38 39 40
#include <linux/hdreg.h>
#include <linux/spinlock.h>
#include <linux/compat.h>
41
#include <linux/blktrace_api.h>
L
Linus Torvalds 已提交
42 43 44
#include <asm/uaccess.h>
#include <asm/io.h>

45
#include <linux/dma-mapping.h>
L
Linus Torvalds 已提交
46 47 48 49 50
#include <linux/blkdev.h>
#include <linux/genhd.h>
#include <linux/completion.h>

#define CCISS_DRIVER_VERSION(maj,min,submin) ((maj<<16)|(min<<8)|(submin))
51 52
#define DRIVER_NAME "HP CISS Driver (v 2.6.10)"
#define DRIVER_VERSION CCISS_DRIVER_VERSION(2,6,10)
L
Linus Torvalds 已提交
53 54 55

/* Embedded module documentation macros - see modules.h */
MODULE_AUTHOR("Hewlett-Packard Company");
56
MODULE_DESCRIPTION("Driver for HP Controller SA5xxx SA6xxx version 2.6.10");
L
Linus Torvalds 已提交
57
MODULE_SUPPORTED_DEVICE("HP SA5i SA5i+ SA532 SA5300 SA5312 SA641 SA642 SA6400"
58
			" SA6i P600 P800 P400 P400i E200 E200i");
L
Linus Torvalds 已提交
59 60 61 62 63 64 65 66
MODULE_LICENSE("GPL");

#include "cciss_cmd.h"
#include "cciss.h"
#include <linux/cciss_ioctl.h>

/* define the PCI info for the cards we can control */
static const struct pci_device_id cciss_pci_device_id[] = {
67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84
	{PCI_VENDOR_ID_COMPAQ, PCI_DEVICE_ID_COMPAQ_CISS,  0x0E11, 0x4070},
	{PCI_VENDOR_ID_COMPAQ, PCI_DEVICE_ID_COMPAQ_CISSB, 0x0E11, 0x4080},
	{PCI_VENDOR_ID_COMPAQ, PCI_DEVICE_ID_COMPAQ_CISSB, 0x0E11, 0x4082},
	{PCI_VENDOR_ID_COMPAQ, PCI_DEVICE_ID_COMPAQ_CISSB, 0x0E11, 0x4083},
	{PCI_VENDOR_ID_COMPAQ, PCI_DEVICE_ID_COMPAQ_CISSC, 0x0E11, 0x4091},
	{PCI_VENDOR_ID_COMPAQ, PCI_DEVICE_ID_COMPAQ_CISSC, 0x0E11, 0x409A},
	{PCI_VENDOR_ID_COMPAQ, PCI_DEVICE_ID_COMPAQ_CISSC, 0x0E11, 0x409B},
	{PCI_VENDOR_ID_COMPAQ, PCI_DEVICE_ID_COMPAQ_CISSC, 0x0E11, 0x409C},
	{PCI_VENDOR_ID_COMPAQ, PCI_DEVICE_ID_COMPAQ_CISSC, 0x0E11, 0x409D},
	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSA,     0x103C, 0x3225},
	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSC,     0x103C, 0x3223},
	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSC,     0x103C, 0x3234},
	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSC,     0x103C, 0x3235},
	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSD,     0x103C, 0x3211},
	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSD,     0x103C, 0x3212},
	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSD,     0x103C, 0x3213},
	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSD,     0x103C, 0x3214},
	{PCI_VENDOR_ID_HP,     PCI_DEVICE_ID_HP_CISSD,     0x103C, 0x3215},
L
Linus Torvalds 已提交
85 86
	{0,}
};
87

L
Linus Torvalds 已提交
88 89 90 91
MODULE_DEVICE_TABLE(pci, cciss_pci_device_id);

/*  board_id = Subsystem Device ID & Vendor ID
 *  product = Marketing Name for the board
92
 *  access = Address of the struct of function pointers
L
Linus Torvalds 已提交
93 94
 */
static struct board_type products[] = {
95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112
	{0x40700E11, "Smart Array 5300", &SA5_access},
	{0x40800E11, "Smart Array 5i", &SA5B_access},
	{0x40820E11, "Smart Array 532", &SA5B_access},
	{0x40830E11, "Smart Array 5312", &SA5B_access},
	{0x409A0E11, "Smart Array 641", &SA5_access},
	{0x409B0E11, "Smart Array 642", &SA5_access},
	{0x409C0E11, "Smart Array 6400", &SA5_access},
	{0x409D0E11, "Smart Array 6400 EM", &SA5_access},
	{0x40910E11, "Smart Array 6i", &SA5_access},
	{0x3225103C, "Smart Array P600", &SA5_access},
	{0x3223103C, "Smart Array P800", &SA5_access},
	{0x3234103C, "Smart Array P400", &SA5_access},
	{0x3235103C, "Smart Array P400i", &SA5_access},
	{0x3211103C, "Smart Array E200i", &SA5_access},
	{0x3212103C, "Smart Array E200", &SA5_access},
	{0x3213103C, "Smart Array E200i", &SA5_access},
	{0x3214103C, "Smart Array E200i", &SA5_access},
	{0x3215103C, "Smart Array E200i", &SA5_access},
L
Linus Torvalds 已提交
113 114
};

115
/* How long to wait (in milliseconds) for board to go into simple mode */
116
#define MAX_CONFIG_WAIT 30000
L
Linus Torvalds 已提交
117 118 119 120 121 122
#define MAX_IOCTL_CONFIG_WAIT 1000

/*define how many times we will try a command because of bus resets */
#define MAX_CMD_RETRIES 3

#define READ_AHEAD 	 1024
123
#define NR_CMDS		 384	/* #commands that can be outstanding */
L
Linus Torvalds 已提交
124 125 126 127 128 129 130 131
#define MAX_CTLR	32

/* Originally cciss driver only supports 8 major numbers */
#define MAX_CTLR_ORIG 	8

static ctlr_info_t *hba[MAX_CTLR];

static void do_cciss_request(request_queue_t *q);
132
static irqreturn_t do_cciss_intr(int irq, void *dev_id, struct pt_regs *regs);
L
Linus Torvalds 已提交
133 134
static int cciss_open(struct inode *inode, struct file *filep);
static int cciss_release(struct inode *inode, struct file *filep);
135 136
static int cciss_ioctl(struct inode *inode, struct file *filep,
		       unsigned int cmd, unsigned long arg);
137
static int cciss_getgeo(struct block_device *bdev, struct hd_geometry *geo);
L
Linus Torvalds 已提交
138 139 140

static int revalidate_allvol(ctlr_info_t *host);
static int cciss_revalidate(struct gendisk *disk);
141
static int rebuild_lun_table(ctlr_info_t *h, struct gendisk *del_disk);
142 143
static int deregister_disk(struct gendisk *disk, drive_info_struct *drv,
			   int clear_all);
L
Linus Torvalds 已提交
144

145
static void cciss_read_capacity(int ctlr, int logvol, ReadCapdata_struct *buf,
146 147 148 149 150 151 152
				int withirq, unsigned int *total_size,
				unsigned int *block_size);
static void cciss_geometry_inquiry(int ctlr, int logvol, int withirq,
				   unsigned int total_size,
				   unsigned int block_size,
				   InquiryData_struct *inq_buff,
				   drive_info_struct *drv);
L
Linus Torvalds 已提交
153
static void cciss_getgeometry(int cntl_num);
154 155 156 157 158 159 160 161 162
static void __devinit cciss_interrupt_mode(ctlr_info_t *, struct pci_dev *,
					   __u32);
static void start_io(ctlr_info_t *h);
static int sendcmd(__u8 cmd, int ctlr, void *buff, size_t size,
		   unsigned int use_unit_num, unsigned int log_unit,
		   __u8 page_code, unsigned char *scsi3addr, int cmd_type);
static int sendcmd_withirq(__u8 cmd, int ctlr, void *buff, size_t size,
			   unsigned int use_unit_num, unsigned int log_unit,
			   __u8 page_code, int cmd_type);
L
Linus Torvalds 已提交
163

164 165
static void fail_all_cmds(unsigned long ctlr);

L
Linus Torvalds 已提交
166
#ifdef CONFIG_PROC_FS
167 168
static int cciss_proc_get_info(char *buffer, char **start, off_t offset,
			       int length, int *eof, void *data);
L
Linus Torvalds 已提交
169 170
static void cciss_procinit(int i);
#else
171 172 173 174
static void cciss_procinit(int i)
{
}
#endif				/* CONFIG_PROC_FS */
L
Linus Torvalds 已提交
175 176 177 178 179

#ifdef CONFIG_COMPAT
static long cciss_compat_ioctl(struct file *f, unsigned cmd, unsigned long arg);
#endif

180 181 182 183 184 185
static struct block_device_operations cciss_fops = {
	.owner = THIS_MODULE,
	.open = cciss_open,
	.release = cciss_release,
	.ioctl = cciss_ioctl,
	.getgeo = cciss_getgeo,
L
Linus Torvalds 已提交
186
#ifdef CONFIG_COMPAT
187
	.compat_ioctl = cciss_compat_ioctl,
L
Linus Torvalds 已提交
188
#endif
189
	.revalidate_disk = cciss_revalidate,
L
Linus Torvalds 已提交
190 191 192 193 194 195 196
};

/*
 * Enqueuing and dequeuing functions for cmdlists.
 */
static inline void addQ(CommandList_struct **Qptr, CommandList_struct *c)
{
197 198 199 200 201 202 203 204 205
	if (*Qptr == NULL) {
		*Qptr = c;
		c->next = c->prev = c;
	} else {
		c->prev = (*Qptr)->prev;
		c->next = (*Qptr);
		(*Qptr)->prev->next = c;
		(*Qptr)->prev = c;
	}
L
Linus Torvalds 已提交
206 207
}

208 209
static inline CommandList_struct *removeQ(CommandList_struct **Qptr,
					  CommandList_struct *c)
L
Linus Torvalds 已提交
210
{
211 212 213 214 215 216 217 218 219
	if (c && c->next != c) {
		if (*Qptr == c)
			*Qptr = c->next;
		c->prev->next = c->next;
		c->next->prev = c->prev;
	} else {
		*Qptr = NULL;
	}
	return c;
L
Linus Torvalds 已提交
220 221 222 223 224 225 226 227 228 229 230 231
}

#include "cciss_scsi.c"		/* For SCSI tape support */

#ifdef CONFIG_PROC_FS

/*
 * Report information about this controller.
 */
#define ENG_GIG 1000000000
#define ENG_GIG_FACTOR (ENG_GIG/512)
#define RAID_UNKNOWN 6
232 233 234
static const char *raid_label[] = { "0", "4", "1(1+0)", "5", "5+1", "ADG",
	"UNKNOWN"
};
L
Linus Torvalds 已提交
235 236 237

static struct proc_dir_entry *proc_cciss;

238 239
static int cciss_proc_get_info(char *buffer, char **start, off_t offset,
			       int length, int *eof, void *data)
L
Linus Torvalds 已提交
240
{
241 242 243 244 245
	off_t pos = 0;
	off_t len = 0;
	int size, i, ctlr;
	ctlr_info_t *h = (ctlr_info_t *) data;
	drive_info_struct *drv;
L
Linus Torvalds 已提交
246
	unsigned long flags;
247
	sector_t vol_sz, vol_sz_frac;
L
Linus Torvalds 已提交
248

249
	ctlr = h->ctlr;
L
Linus Torvalds 已提交
250 251 252 253 254 255 256

	/* prevent displaying bogus info during configuration
	 * or deconfiguration of a logical volume
	 */
	spin_lock_irqsave(CCISS_LOCK(ctlr), flags);
	if (h->busy_configuring) {
		spin_unlock_irqrestore(CCISS_LOCK(ctlr), flags);
257
		return -EBUSY;
L
Linus Torvalds 已提交
258 259 260 261
	}
	h->busy_configuring = 1;
	spin_unlock_irqrestore(CCISS_LOCK(ctlr), flags);

262 263 264 265 266 267 268 269 270 271 272 273 274 275 276 277 278 279 280 281
	size = sprintf(buffer, "%s: HP %s Controller\n"
		       "Board ID: 0x%08lx\n"
		       "Firmware Version: %c%c%c%c\n"
		       "IRQ: %d\n"
		       "Logical drives: %d\n"
		       "Current Q depth: %d\n"
		       "Current # commands on controller: %d\n"
		       "Max Q depth since init: %d\n"
		       "Max # commands on controller since init: %d\n"
		       "Max SG entries since init: %d\n\n",
		       h->devname,
		       h->product_name,
		       (unsigned long)h->board_id,
		       h->firm_ver[0], h->firm_ver[1], h->firm_ver[2],
		       h->firm_ver[3], (unsigned int)h->intr[SIMPLE_MODE_INT],
		       h->num_luns, h->Qdepth, h->commands_outstanding,
		       h->maxQsinceinit, h->max_outstanding, h->maxSG);

	pos += size;
	len += size;
L
Linus Torvalds 已提交
282
	cciss_proc_tape_report(ctlr, buffer, &pos, &len);
283
	for (i = 0; i <= h->highest_lun; i++) {
L
Linus Torvalds 已提交
284

285
		drv = &h->drv[i];
286
		if (drv->heads == 0)
L
Linus Torvalds 已提交
287 288 289 290 291 292 293 294 295
			continue;

		vol_sz = drv->nr_blocks;
		vol_sz_frac = sector_div(vol_sz, ENG_GIG_FACTOR);
		vol_sz_frac *= 100;
		sector_div(vol_sz_frac, ENG_GIG_FACTOR);

		if (drv->raid_level > 5)
			drv->raid_level = RAID_UNKNOWN;
296 297 298 299 300 301 302 303 304 305 306 307 308
		size = sprintf(buffer + len, "cciss/c%dd%d:"
			       "\t%4u.%02uGB\tRAID %s\n",
			       ctlr, i, (int)vol_sz, (int)vol_sz_frac,
			       raid_label[drv->raid_level]);
		pos += size;
		len += size;
	}

	*eof = 1;
	*start = buffer + offset;
	len -= offset;
	if (len > length)
		len = length;
L
Linus Torvalds 已提交
309
	h->busy_configuring = 0;
310
	return len;
L
Linus Torvalds 已提交
311 312
}

313 314 315
static int
cciss_proc_write(struct file *file, const char __user *buffer,
		 unsigned long count, void *data)
L
Linus Torvalds 已提交
316 317 318 319 320 321 322 323
{
	unsigned char cmd[80];
	int len;
#ifdef CONFIG_CISS_SCSI_TAPE
	ctlr_info_t *h = (ctlr_info_t *) data;
	int rc;
#endif

324 325 326 327
	if (count > sizeof(cmd) - 1)
		return -EINVAL;
	if (copy_from_user(cmd, buffer, count))
		return -EFAULT;
L
Linus Torvalds 已提交
328 329
	cmd[count] = '\0';
	len = strlen(cmd);	// above 3 lines ensure safety
330
	if (len && cmd[len - 1] == '\n')
L
Linus Torvalds 已提交
331 332
		cmd[--len] = '\0';
#	ifdef CONFIG_CISS_SCSI_TAPE
333 334 335 336 337 338 339 340
	if (strcmp("engage scsi", cmd) == 0) {
		rc = cciss_engage_scsi(h->ctlr);
		if (rc != 0)
			return -rc;
		return count;
	}
	/* might be nice to have "disengage" too, but it's not
	   safely possible. (only 1 module use count, lock issues.) */
L
Linus Torvalds 已提交
341 342 343 344 345 346 347 348 349 350 351 352
#	endif
	return -EINVAL;
}

/*
 * Get us a file in /proc/cciss that says something about each controller.
 * Create /proc/cciss if it doesn't exist yet.
 */
static void __devinit cciss_procinit(int i)
{
	struct proc_dir_entry *pde;

353 354 355
	if (proc_cciss == NULL) {
		proc_cciss = proc_mkdir("cciss", proc_root_driver);
		if (!proc_cciss)
L
Linus Torvalds 已提交
356
			return;
357
	}
L
Linus Torvalds 已提交
358

359 360 361
	pde = create_proc_read_entry(hba[i]->devname,
				     S_IWUSR | S_IRUSR | S_IRGRP | S_IROTH,
				     proc_cciss, cciss_proc_get_info, hba[i]);
L
Linus Torvalds 已提交
362 363
	pde->write_proc = cciss_proc_write;
}
364
#endif				/* CONFIG_PROC_FS */
L
Linus Torvalds 已提交
365

366 367
/*
 * For operations that cannot sleep, a command block is allocated at init,
L
Linus Torvalds 已提交
368
 * and managed by cmd_alloc() and cmd_free() using a simple bitmap to track
369 370 371 372 373
 * which ones are free or in use.  For operations that can wait for kmalloc
 * to possible sleep, this routine can be called with get_from_pool set to 0.
 * cmd_free() MUST be called with a got_from_pool set to 0 if cmd_alloc was.
 */
static CommandList_struct *cmd_alloc(ctlr_info_t *h, int get_from_pool)
L
Linus Torvalds 已提交
374 375
{
	CommandList_struct *c;
376
	int i;
L
Linus Torvalds 已提交
377 378 379
	u64bit temp64;
	dma_addr_t cmd_dma_handle, err_dma_handle;

380 381 382 383 384
	if (!get_from_pool) {
		c = (CommandList_struct *) pci_alloc_consistent(h->pdev,
			sizeof(CommandList_struct), &cmd_dma_handle);
		if (c == NULL)
			return NULL;
L
Linus Torvalds 已提交
385 386
		memset(c, 0, sizeof(CommandList_struct));

387 388
		c->cmdindex = -1;

389 390 391 392 393 394
		c->err_info = (ErrorInfo_struct *)
		    pci_alloc_consistent(h->pdev, sizeof(ErrorInfo_struct),
			    &err_dma_handle);

		if (c->err_info == NULL) {
			pci_free_consistent(h->pdev,
L
Linus Torvalds 已提交
395 396 397 398
				sizeof(CommandList_struct), c, cmd_dma_handle);
			return NULL;
		}
		memset(c->err_info, 0, sizeof(ErrorInfo_struct));
399 400 401 402 403 404 405 406 407
	} else {		/* get it out of the controllers pool */

		do {
			i = find_first_zero_bit(h->cmd_pool_bits, NR_CMDS);
			if (i == NR_CMDS)
				return NULL;
		} while (test_and_set_bit
			 (i & (BITS_PER_LONG - 1),
			  h->cmd_pool_bits + (i / BITS_PER_LONG)) != 0);
L
Linus Torvalds 已提交
408 409 410
#ifdef CCISS_DEBUG
		printk(KERN_DEBUG "cciss: using command buffer %d\n", i);
#endif
411
		c = h->cmd_pool + i;
L
Linus Torvalds 已提交
412
		memset(c, 0, sizeof(CommandList_struct));
413 414
		cmd_dma_handle = h->cmd_pool_dhandle
		    + i * sizeof(CommandList_struct);
L
Linus Torvalds 已提交
415 416
		c->err_info = h->errinfo_pool + i;
		memset(c->err_info, 0, sizeof(ErrorInfo_struct));
417 418 419
		err_dma_handle = h->errinfo_pool_dhandle
		    + i * sizeof(ErrorInfo_struct);
		h->nr_allocs++;
420 421

		c->cmdindex = i;
422
	}
L
Linus Torvalds 已提交
423 424

	c->busaddr = (__u32) cmd_dma_handle;
425
	temp64.val = (__u64) err_dma_handle;
L
Linus Torvalds 已提交
426 427 428 429
	c->ErrDesc.Addr.lower = temp64.val32.lower;
	c->ErrDesc.Addr.upper = temp64.val32.upper;
	c->ErrDesc.Len = sizeof(ErrorInfo_struct);

430 431
	c->ctlr = h->ctlr;
	return c;
L
Linus Torvalds 已提交
432 433
}

434 435
/*
 * Frees a command block that was previously allocated with cmd_alloc().
L
Linus Torvalds 已提交
436 437 438 439 440 441
 */
static void cmd_free(ctlr_info_t *h, CommandList_struct *c, int got_from_pool)
{
	int i;
	u64bit temp64;

442
	if (!got_from_pool) {
L
Linus Torvalds 已提交
443 444
		temp64.val32.lower = c->ErrDesc.Addr.lower;
		temp64.val32.upper = c->ErrDesc.Addr.upper;
445 446 447 448 449
		pci_free_consistent(h->pdev, sizeof(ErrorInfo_struct),
				    c->err_info, (dma_addr_t) temp64.val);
		pci_free_consistent(h->pdev, sizeof(CommandList_struct),
				    c, (dma_addr_t) c->busaddr);
	} else {
L
Linus Torvalds 已提交
450
		i = c - h->cmd_pool;
451 452 453 454
		clear_bit(i & (BITS_PER_LONG - 1),
			  h->cmd_pool_bits + (i / BITS_PER_LONG));
		h->nr_frees++;
	}
L
Linus Torvalds 已提交
455 456 457 458
}

static inline ctlr_info_t *get_host(struct gendisk *disk)
{
459
	return disk->queue->queuedata;
L
Linus Torvalds 已提交
460 461 462 463 464 465 466 467 468 469 470 471 472 473 474 475 476
}

static inline drive_info_struct *get_drv(struct gendisk *disk)
{
	return disk->private_data;
}

/*
 * Open.  Make sure the device is really there.
 */
static int cciss_open(struct inode *inode, struct file *filep)
{
	ctlr_info_t *host = get_host(inode->i_bdev->bd_disk);
	drive_info_struct *drv = get_drv(inode->i_bdev->bd_disk);

#ifdef CCISS_DEBUG
	printk(KERN_DEBUG "cciss_open %s\n", inode->i_bdev->bd_disk->disk_name);
477
#endif				/* CCISS_DEBUG */
L
Linus Torvalds 已提交
478

479 480
	if (host->busy_initializing || drv->busy_configuring)
		return -EBUSY;
L
Linus Torvalds 已提交
481 482 483 484 485 486 487 488 489
	/*
	 * Root is allowed to open raw volume zero even if it's not configured
	 * so array config can still work. Root is also allowed to open any
	 * volume that has a LUN ID, so it can issue IOCTL to reread the
	 * disk information.  I don't think I really like this
	 * but I'm already using way to many device nodes to claim another one
	 * for "raw controller".
	 */
	if (drv->nr_blocks == 0) {
490
		if (iminor(inode) != 0) {	/* not node 0? */
L
Linus Torvalds 已提交
491 492
			/* if not node 0 make sure it is a partition = 0 */
			if (iminor(inode) & 0x0f) {
493
				return -ENXIO;
L
Linus Torvalds 已提交
494 495 496 497 498 499 500 501 502 503 504 505
				/* if it is, make sure we have a LUN ID */
			} else if (drv->LunID == 0) {
				return -ENXIO;
			}
		}
		if (!capable(CAP_SYS_ADMIN))
			return -EPERM;
	}
	drv->usage_count++;
	host->usage_count++;
	return 0;
}
506

L
Linus Torvalds 已提交
507 508 509 510 511 512 513 514 515
/*
 * Close.  Sync first.
 */
static int cciss_release(struct inode *inode, struct file *filep)
{
	ctlr_info_t *host = get_host(inode->i_bdev->bd_disk);
	drive_info_struct *drv = get_drv(inode->i_bdev->bd_disk);

#ifdef CCISS_DEBUG
516 517 518
	printk(KERN_DEBUG "cciss_release %s\n",
	       inode->i_bdev->bd_disk->disk_name);
#endif				/* CCISS_DEBUG */
L
Linus Torvalds 已提交
519 520 521 522 523 524 525 526 527 528 529 530 531 532 533 534 535

	drv->usage_count--;
	host->usage_count--;
	return 0;
}

#ifdef CONFIG_COMPAT

static int do_ioctl(struct file *f, unsigned cmd, unsigned long arg)
{
	int ret;
	lock_kernel();
	ret = cciss_ioctl(f->f_dentry->d_inode, f, cmd, arg);
	unlock_kernel();
	return ret;
}

536 537 538 539
static int cciss_ioctl32_passthru(struct file *f, unsigned cmd,
				  unsigned long arg);
static int cciss_ioctl32_big_passthru(struct file *f, unsigned cmd,
				      unsigned long arg);
L
Linus Torvalds 已提交
540 541 542 543 544 545 546 547 548 549 550 551 552 553 554 555 556 557 558 559 560 561 562 563 564 565 566 567 568 569 570

static long cciss_compat_ioctl(struct file *f, unsigned cmd, unsigned long arg)
{
	switch (cmd) {
	case CCISS_GETPCIINFO:
	case CCISS_GETINTINFO:
	case CCISS_SETINTINFO:
	case CCISS_GETNODENAME:
	case CCISS_SETNODENAME:
	case CCISS_GETHEARTBEAT:
	case CCISS_GETBUSTYPES:
	case CCISS_GETFIRMVER:
	case CCISS_GETDRIVVER:
	case CCISS_REVALIDVOLS:
	case CCISS_DEREGDISK:
	case CCISS_REGNEWDISK:
	case CCISS_REGNEWD:
	case CCISS_RESCANDISK:
	case CCISS_GETLUNINFO:
		return do_ioctl(f, cmd, arg);

	case CCISS_PASSTHRU32:
		return cciss_ioctl32_passthru(f, cmd, arg);
	case CCISS_BIG_PASSTHRU32:
		return cciss_ioctl32_big_passthru(f, cmd, arg);

	default:
		return -ENOIOCTLCMD;
	}
}

571 572
static int cciss_ioctl32_passthru(struct file *f, unsigned cmd,
				  unsigned long arg)
L
Linus Torvalds 已提交
573 574
{
	IOCTL32_Command_struct __user *arg32 =
575
	    (IOCTL32_Command_struct __user *) arg;
L
Linus Torvalds 已提交
576 577 578 579 580 581
	IOCTL_Command_struct arg64;
	IOCTL_Command_struct __user *p = compat_alloc_user_space(sizeof(arg64));
	int err;
	u32 cp;

	err = 0;
582 583 584 585 586 587 588 589 590
	err |=
	    copy_from_user(&arg64.LUN_info, &arg32->LUN_info,
			   sizeof(arg64.LUN_info));
	err |=
	    copy_from_user(&arg64.Request, &arg32->Request,
			   sizeof(arg64.Request));
	err |=
	    copy_from_user(&arg64.error_info, &arg32->error_info,
			   sizeof(arg64.error_info));
L
Linus Torvalds 已提交
591 592 593 594 595 596 597 598
	err |= get_user(arg64.buf_size, &arg32->buf_size);
	err |= get_user(cp, &arg32->buf);
	arg64.buf = compat_ptr(cp);
	err |= copy_to_user(p, &arg64, sizeof(arg64));

	if (err)
		return -EFAULT;

599
	err = do_ioctl(f, CCISS_PASSTHRU, (unsigned long)p);
L
Linus Torvalds 已提交
600 601
	if (err)
		return err;
602 603 604
	err |=
	    copy_in_user(&arg32->error_info, &p->error_info,
			 sizeof(arg32->error_info));
L
Linus Torvalds 已提交
605 606 607 608 609
	if (err)
		return -EFAULT;
	return err;
}

610 611
static int cciss_ioctl32_big_passthru(struct file *file, unsigned cmd,
				      unsigned long arg)
L
Linus Torvalds 已提交
612 613
{
	BIG_IOCTL32_Command_struct __user *arg32 =
614
	    (BIG_IOCTL32_Command_struct __user *) arg;
L
Linus Torvalds 已提交
615
	BIG_IOCTL_Command_struct arg64;
616 617
	BIG_IOCTL_Command_struct __user *p =
	    compat_alloc_user_space(sizeof(arg64));
L
Linus Torvalds 已提交
618 619 620 621
	int err;
	u32 cp;

	err = 0;
622 623 624 625 626 627 628 629 630
	err |=
	    copy_from_user(&arg64.LUN_info, &arg32->LUN_info,
			   sizeof(arg64.LUN_info));
	err |=
	    copy_from_user(&arg64.Request, &arg32->Request,
			   sizeof(arg64.Request));
	err |=
	    copy_from_user(&arg64.error_info, &arg32->error_info,
			   sizeof(arg64.error_info));
L
Linus Torvalds 已提交
631 632 633 634 635 636 637
	err |= get_user(arg64.buf_size, &arg32->buf_size);
	err |= get_user(arg64.malloc_size, &arg32->malloc_size);
	err |= get_user(cp, &arg32->buf);
	arg64.buf = compat_ptr(cp);
	err |= copy_to_user(p, &arg64, sizeof(arg64));

	if (err)
638
		return -EFAULT;
L
Linus Torvalds 已提交
639

640
	err = do_ioctl(file, CCISS_BIG_PASSTHRU, (unsigned long)p);
L
Linus Torvalds 已提交
641 642
	if (err)
		return err;
643 644 645
	err |=
	    copy_in_user(&arg32->error_info, &p->error_info,
			 sizeof(arg32->error_info));
L
Linus Torvalds 已提交
646 647 648 649 650
	if (err)
		return -EFAULT;
	return err;
}
#endif
651 652 653 654 655 656 657 658 659 660 661 662 663 664

static int cciss_getgeo(struct block_device *bdev, struct hd_geometry *geo)
{
	drive_info_struct *drv = get_drv(bdev->bd_disk);

	if (!drv->cylinders)
		return -ENXIO;

	geo->heads = drv->heads;
	geo->sectors = drv->sectors;
	geo->cylinders = drv->cylinders;
	return 0;
}

L
Linus Torvalds 已提交
665
/*
666
 * ioctl
L
Linus Torvalds 已提交
667
 */
668 669
static int cciss_ioctl(struct inode *inode, struct file *filep,
		       unsigned int cmd, unsigned long arg)
L
Linus Torvalds 已提交
670 671 672 673 674 675 676 677 678 679
{
	struct block_device *bdev = inode->i_bdev;
	struct gendisk *disk = bdev->bd_disk;
	ctlr_info_t *host = get_host(disk);
	drive_info_struct *drv = get_drv(disk);
	int ctlr = host->ctlr;
	void __user *argp = (void __user *)arg;

#ifdef CCISS_DEBUG
	printk(KERN_DEBUG "cciss_ioctl: Called with cmd=%x %lx\n", cmd, arg);
680 681 682
#endif				/* CCISS_DEBUG */

	switch (cmd) {
L
Linus Torvalds 已提交
683
	case CCISS_GETPCIINFO:
684 685 686 687 688 689 690 691 692 693 694 695 696 697
		{
			cciss_pci_info_struct pciinfo;

			if (!arg)
				return -EINVAL;
			pciinfo.domain = pci_domain_nr(host->pdev->bus);
			pciinfo.bus = host->pdev->bus->number;
			pciinfo.dev_fn = host->pdev->devfn;
			pciinfo.board_id = host->board_id;
			if (copy_to_user
			    (argp, &pciinfo, sizeof(cciss_pci_info_struct)))
				return -EFAULT;
			return 0;
		}
L
Linus Torvalds 已提交
698
	case CCISS_GETINTINFO:
699 700 701 702 703 704 705 706 707 708 709 710 711
		{
			cciss_coalint_struct intinfo;
			if (!arg)
				return -EINVAL;
			intinfo.delay =
			    readl(&host->cfgtable->HostWrite.CoalIntDelay);
			intinfo.count =
			    readl(&host->cfgtable->HostWrite.CoalIntCount);
			if (copy_to_user
			    (argp, &intinfo, sizeof(cciss_coalint_struct)))
				return -EFAULT;
			return 0;
		}
L
Linus Torvalds 已提交
712 713
	case CCISS_SETINTINFO:
		{
714 715 716 717 718 719 720 721 722 723 724 725 726 727 728 729 730 731 732 733 734 735 736 737 738 739 740 741 742 743 744 745 746 747 748
			cciss_coalint_struct intinfo;
			unsigned long flags;
			int i;

			if (!arg)
				return -EINVAL;
			if (!capable(CAP_SYS_ADMIN))
				return -EPERM;
			if (copy_from_user
			    (&intinfo, argp, sizeof(cciss_coalint_struct)))
				return -EFAULT;
			if ((intinfo.delay == 0) && (intinfo.count == 0))
			{
//                      printk("cciss_ioctl: delay and count cannot be 0\n");
				return -EINVAL;
			}
			spin_lock_irqsave(CCISS_LOCK(ctlr), flags);
			/* Update the field, and then ring the doorbell */
			writel(intinfo.delay,
			       &(host->cfgtable->HostWrite.CoalIntDelay));
			writel(intinfo.count,
			       &(host->cfgtable->HostWrite.CoalIntCount));
			writel(CFGTBL_ChangeReq, host->vaddr + SA5_DOORBELL);

			for (i = 0; i < MAX_IOCTL_CONFIG_WAIT; i++) {
				if (!(readl(host->vaddr + SA5_DOORBELL)
				      & CFGTBL_ChangeReq))
					break;
				/* delay and try again */
				udelay(1000);
			}
			spin_unlock_irqrestore(CCISS_LOCK(ctlr), flags);
			if (i >= MAX_IOCTL_CONFIG_WAIT)
				return -EAGAIN;
			return 0;
L
Linus Torvalds 已提交
749 750
		}
	case CCISS_GETNODENAME:
751 752 753 754 755 756 757 758 759 760 761 762 763
		{
			NodeName_type NodeName;
			int i;

			if (!arg)
				return -EINVAL;
			for (i = 0; i < 16; i++)
				NodeName[i] =
				    readb(&host->cfgtable->ServerName[i]);
			if (copy_to_user(argp, NodeName, sizeof(NodeName_type)))
				return -EFAULT;
			return 0;
		}
L
Linus Torvalds 已提交
764
	case CCISS_SETNODENAME:
765 766 767 768 769 770 771 772 773 774 775 776 777 778 779 780 781 782 783 784 785 786 787 788 789 790 791 792 793 794 795 796 797 798 799
		{
			NodeName_type NodeName;
			unsigned long flags;
			int i;

			if (!arg)
				return -EINVAL;
			if (!capable(CAP_SYS_ADMIN))
				return -EPERM;

			if (copy_from_user
			    (NodeName, argp, sizeof(NodeName_type)))
				return -EFAULT;

			spin_lock_irqsave(CCISS_LOCK(ctlr), flags);

			/* Update the field, and then ring the doorbell */
			for (i = 0; i < 16; i++)
				writeb(NodeName[i],
				       &host->cfgtable->ServerName[i]);

			writel(CFGTBL_ChangeReq, host->vaddr + SA5_DOORBELL);

			for (i = 0; i < MAX_IOCTL_CONFIG_WAIT; i++) {
				if (!(readl(host->vaddr + SA5_DOORBELL)
				      & CFGTBL_ChangeReq))
					break;
				/* delay and try again */
				udelay(1000);
			}
			spin_unlock_irqrestore(CCISS_LOCK(ctlr), flags);
			if (i >= MAX_IOCTL_CONFIG_WAIT)
				return -EAGAIN;
			return 0;
		}
L
Linus Torvalds 已提交
800 801

	case CCISS_GETHEARTBEAT:
802 803 804 805 806 807 808 809 810 811 812
		{
			Heartbeat_type heartbeat;

			if (!arg)
				return -EINVAL;
			heartbeat = readl(&host->cfgtable->HeartBeat);
			if (copy_to_user
			    (argp, &heartbeat, sizeof(Heartbeat_type)))
				return -EFAULT;
			return 0;
		}
L
Linus Torvalds 已提交
813
	case CCISS_GETBUSTYPES:
814 815 816 817 818 819 820 821 822 823 824
		{
			BusTypes_type BusTypes;

			if (!arg)
				return -EINVAL;
			BusTypes = readl(&host->cfgtable->BusTypes);
			if (copy_to_user
			    (argp, &BusTypes, sizeof(BusTypes_type)))
				return -EFAULT;
			return 0;
		}
L
Linus Torvalds 已提交
825
	case CCISS_GETFIRMVER:
826 827
		{
			FirmwareVer_type firmware;
L
Linus Torvalds 已提交
828

829 830 831
			if (!arg)
				return -EINVAL;
			memcpy(firmware, host->firm_ver, 4);
L
Linus Torvalds 已提交
832

833 834 835 836 837 838 839 840
			if (copy_to_user
			    (argp, firmware, sizeof(FirmwareVer_type)))
				return -EFAULT;
			return 0;
		}
	case CCISS_GETDRIVVER:
		{
			DriverVer_type DriverVer = DRIVER_VERSION;
L
Linus Torvalds 已提交
841

842 843
			if (!arg)
				return -EINVAL;
L
Linus Torvalds 已提交
844

845 846 847 848 849
			if (copy_to_user
			    (argp, &DriverVer, sizeof(DriverVer_type)))
				return -EFAULT;
			return 0;
		}
L
Linus Torvalds 已提交
850 851 852 853

	case CCISS_REVALIDVOLS:
		if (bdev != bdev->bd_contains || drv != host->drv)
			return -ENXIO;
854 855 856 857 858 859 860 861 862 863 864 865 866
		return revalidate_allvol(host);

	case CCISS_GETLUNINFO:{
			LogvolInfo_struct luninfo;

			luninfo.LunID = drv->LunID;
			luninfo.num_opens = drv->usage_count;
			luninfo.num_parts = 0;
			if (copy_to_user(argp, &luninfo,
					 sizeof(LogvolInfo_struct)))
				return -EFAULT;
			return 0;
		}
L
Linus Torvalds 已提交
867
	case CCISS_DEREGDISK:
868
		return rebuild_lun_table(host, disk);
L
Linus Torvalds 已提交
869 870

	case CCISS_REGNEWD:
871
		return rebuild_lun_table(host, NULL);
L
Linus Torvalds 已提交
872 873 874

	case CCISS_PASSTHRU:
		{
875 876 877 878 879 880
			IOCTL_Command_struct iocommand;
			CommandList_struct *c;
			char *buff = NULL;
			u64bit temp64;
			unsigned long flags;
			DECLARE_COMPLETION(wait);
L
Linus Torvalds 已提交
881

882 883
			if (!arg)
				return -EINVAL;
L
Linus Torvalds 已提交
884

885 886
			if (!capable(CAP_SYS_RAWIO))
				return -EPERM;
L
Linus Torvalds 已提交
887

888 889 890 891 892 893 894 895 896 897 898 899 900 901 902 903 904 905 906 907 908 909 910 911 912 913 914 915 916 917 918 919 920 921 922 923 924 925 926 927 928 929 930 931 932 933
			if (copy_from_user
			    (&iocommand, argp, sizeof(IOCTL_Command_struct)))
				return -EFAULT;
			if ((iocommand.buf_size < 1) &&
			    (iocommand.Request.Type.Direction != XFER_NONE)) {
				return -EINVAL;
			}
#if 0				/* 'buf_size' member is 16-bits, and always smaller than kmalloc limit */
			/* Check kmalloc limits */
			if (iocommand.buf_size > 128000)
				return -EINVAL;
#endif
			if (iocommand.buf_size > 0) {
				buff = kmalloc(iocommand.buf_size, GFP_KERNEL);
				if (buff == NULL)
					return -EFAULT;
			}
			if (iocommand.Request.Type.Direction == XFER_WRITE) {
				/* Copy the data into the buffer we created */
				if (copy_from_user
				    (buff, iocommand.buf, iocommand.buf_size)) {
					kfree(buff);
					return -EFAULT;
				}
			} else {
				memset(buff, 0, iocommand.buf_size);
			}
			if ((c = cmd_alloc(host, 0)) == NULL) {
				kfree(buff);
				return -ENOMEM;
			}
			// Fill in the command type
			c->cmd_type = CMD_IOCTL_PEND;
			// Fill in Command Header
			c->Header.ReplyQueue = 0;	// unused in simple mode
			if (iocommand.buf_size > 0)	// buffer to fill
			{
				c->Header.SGList = 1;
				c->Header.SGTotal = 1;
			} else	// no buffers to fill
			{
				c->Header.SGList = 0;
				c->Header.SGTotal = 0;
			}
			c->Header.LUN = iocommand.LUN_info;
			c->Header.Tag.lower = c->busaddr;	// use the kernel address the cmd block for tag
L
Linus Torvalds 已提交
934

935 936
			// Fill in Request block
			c->Request = iocommand.Request;
L
Linus Torvalds 已提交
937

938 939 940 941 942 943 944 945 946 947 948 949 950 951 952 953 954 955 956 957 958 959 960 961 962 963 964 965 966 967 968 969 970
			// Fill in the scatter gather information
			if (iocommand.buf_size > 0) {
				temp64.val = pci_map_single(host->pdev, buff,
					iocommand.buf_size,
					PCI_DMA_BIDIRECTIONAL);
				c->SG[0].Addr.lower = temp64.val32.lower;
				c->SG[0].Addr.upper = temp64.val32.upper;
				c->SG[0].Len = iocommand.buf_size;
				c->SG[0].Ext = 0;	// we are not chaining
			}
			c->waiting = &wait;

			/* Put the request on the tail of the request queue */
			spin_lock_irqsave(CCISS_LOCK(ctlr), flags);
			addQ(&host->reqQ, c);
			host->Qdepth++;
			start_io(host);
			spin_unlock_irqrestore(CCISS_LOCK(ctlr), flags);

			wait_for_completion(&wait);

			/* unlock the buffers from DMA */
			temp64.val32.lower = c->SG[0].Addr.lower;
			temp64.val32.upper = c->SG[0].Addr.upper;
			pci_unmap_single(host->pdev, (dma_addr_t) temp64.val,
					 iocommand.buf_size,
					 PCI_DMA_BIDIRECTIONAL);

			/* Copy the error information out */
			iocommand.error_info = *(c->err_info);
			if (copy_to_user
			    (argp, &iocommand, sizeof(IOCTL_Command_struct))) {
				kfree(buff);
L
Linus Torvalds 已提交
971 972 973
				cmd_free(host, c, 0);
				return -EFAULT;
			}
974 975 976 977 978 979 980 981 982 983 984 985 986

			if (iocommand.Request.Type.Direction == XFER_READ) {
				/* Copy the data out of the buffer we created */
				if (copy_to_user
				    (iocommand.buf, buff, iocommand.buf_size)) {
					kfree(buff);
					cmd_free(host, c, 0);
					return -EFAULT;
				}
			}
			kfree(buff);
			cmd_free(host, c, 0);
			return 0;
L
Linus Torvalds 已提交
987
		}
988 989 990 991 992 993 994 995 996 997 998 999 1000 1001 1002 1003 1004 1005 1006 1007 1008 1009 1010 1011 1012 1013 1014 1015 1016 1017 1018
	case CCISS_BIG_PASSTHRU:{
			BIG_IOCTL_Command_struct *ioc;
			CommandList_struct *c;
			unsigned char **buff = NULL;
			int *buff_size = NULL;
			u64bit temp64;
			unsigned long flags;
			BYTE sg_used = 0;
			int status = 0;
			int i;
			DECLARE_COMPLETION(wait);
			__u32 left;
			__u32 sz;
			BYTE __user *data_ptr;

			if (!arg)
				return -EINVAL;
			if (!capable(CAP_SYS_RAWIO))
				return -EPERM;
			ioc = (BIG_IOCTL_Command_struct *)
			    kmalloc(sizeof(*ioc), GFP_KERNEL);
			if (!ioc) {
				status = -ENOMEM;
				goto cleanup1;
			}
			if (copy_from_user(ioc, argp, sizeof(*ioc))) {
				status = -EFAULT;
				goto cleanup1;
			}
			if ((ioc->buf_size < 1) &&
			    (ioc->Request.Type.Direction != XFER_NONE)) {
L
Linus Torvalds 已提交
1019 1020
				status = -EINVAL;
				goto cleanup1;
1021 1022 1023 1024 1025 1026 1027 1028 1029 1030 1031 1032 1033
			}
			/* Check kmalloc limits  using all SGs */
			if (ioc->malloc_size > MAX_KMALLOC_SIZE) {
				status = -EINVAL;
				goto cleanup1;
			}
			if (ioc->buf_size > ioc->malloc_size * MAXSGENTRIES) {
				status = -EINVAL;
				goto cleanup1;
			}
			buff =
			    kzalloc(MAXSGENTRIES * sizeof(char *), GFP_KERNEL);
			if (!buff) {
L
Linus Torvalds 已提交
1034 1035 1036
				status = -ENOMEM;
				goto cleanup1;
			}
1037 1038 1039 1040 1041 1042 1043 1044 1045 1046 1047 1048 1049 1050 1051
			buff_size = (int *)kmalloc(MAXSGENTRIES * sizeof(int),
						   GFP_KERNEL);
			if (!buff_size) {
				status = -ENOMEM;
				goto cleanup1;
			}
			left = ioc->buf_size;
			data_ptr = ioc->buf;
			while (left) {
				sz = (left >
				      ioc->malloc_size) ? ioc->
				    malloc_size : left;
				buff_size[sg_used] = sz;
				buff[sg_used] = kmalloc(sz, GFP_KERNEL);
				if (buff[sg_used] == NULL) {
L
Linus Torvalds 已提交
1052
					status = -ENOMEM;
1053 1054
					goto cleanup1;
				}
1055 1056 1057 1058 1059 1060 1061 1062 1063 1064 1065 1066 1067 1068 1069 1070 1071 1072 1073 1074 1075 1076 1077
				if (ioc->Request.Type.Direction == XFER_WRITE) {
					if (copy_from_user
					    (buff[sg_used], data_ptr, sz)) {
						status = -ENOMEM;
						goto cleanup1;
					}
				} else {
					memset(buff[sg_used], 0, sz);
				}
				left -= sz;
				data_ptr += sz;
				sg_used++;
			}
			if ((c = cmd_alloc(host, 0)) == NULL) {
				status = -ENOMEM;
				goto cleanup1;
			}
			c->cmd_type = CMD_IOCTL_PEND;
			c->Header.ReplyQueue = 0;

			if (ioc->buf_size > 0) {
				c->Header.SGList = sg_used;
				c->Header.SGTotal = sg_used;
L
Linus Torvalds 已提交
1078
			} else {
1079 1080
				c->Header.SGList = 0;
				c->Header.SGTotal = 0;
L
Linus Torvalds 已提交
1081
			}
1082 1083 1084 1085 1086 1087 1088 1089 1090 1091 1092 1093 1094 1095 1096 1097 1098 1099 1100 1101 1102 1103 1104 1105 1106 1107 1108 1109 1110 1111 1112 1113 1114
			c->Header.LUN = ioc->LUN_info;
			c->Header.Tag.lower = c->busaddr;

			c->Request = ioc->Request;
			if (ioc->buf_size > 0) {
				int i;
				for (i = 0; i < sg_used; i++) {
					temp64.val =
					    pci_map_single(host->pdev, buff[i],
						    buff_size[i],
						    PCI_DMA_BIDIRECTIONAL);
					c->SG[i].Addr.lower =
					    temp64.val32.lower;
					c->SG[i].Addr.upper =
					    temp64.val32.upper;
					c->SG[i].Len = buff_size[i];
					c->SG[i].Ext = 0;	/* we are not chaining */
				}
			}
			c->waiting = &wait;
			/* Put the request on the tail of the request queue */
			spin_lock_irqsave(CCISS_LOCK(ctlr), flags);
			addQ(&host->reqQ, c);
			host->Qdepth++;
			start_io(host);
			spin_unlock_irqrestore(CCISS_LOCK(ctlr), flags);
			wait_for_completion(&wait);
			/* unlock the buffers from DMA */
			for (i = 0; i < sg_used; i++) {
				temp64.val32.lower = c->SG[i].Addr.lower;
				temp64.val32.upper = c->SG[i].Addr.upper;
				pci_unmap_single(host->pdev,
					(dma_addr_t) temp64.val, buff_size[i],
L
Linus Torvalds 已提交
1115 1116
					PCI_DMA_BIDIRECTIONAL);
			}
1117 1118 1119 1120 1121 1122 1123 1124 1125 1126 1127 1128 1129 1130 1131 1132 1133 1134
			/* Copy the error information out */
			ioc->error_info = *(c->err_info);
			if (copy_to_user(argp, ioc, sizeof(*ioc))) {
				cmd_free(host, c, 0);
				status = -EFAULT;
				goto cleanup1;
			}
			if (ioc->Request.Type.Direction == XFER_READ) {
				/* Copy the data out of the buffer we created */
				BYTE __user *ptr = ioc->buf;
				for (i = 0; i < sg_used; i++) {
					if (copy_to_user
					    (ptr, buff[i], buff_size[i])) {
						cmd_free(host, c, 0);
						status = -EFAULT;
						goto cleanup1;
					}
					ptr += buff_size[i];
L
Linus Torvalds 已提交
1135 1136
				}
			}
1137 1138 1139 1140 1141 1142 1143 1144 1145 1146 1147
			cmd_free(host, c, 0);
			status = 0;
		      cleanup1:
			if (buff) {
				for (i = 0; i < sg_used; i++)
					kfree(buff[i]);
				kfree(buff);
			}
			kfree(buff_size);
			kfree(ioc);
			return status;
L
Linus Torvalds 已提交
1148 1149 1150 1151 1152 1153 1154 1155 1156 1157 1158 1159 1160 1161
		}
	default:
		return -ENOTTY;
	}
}

/*
 * revalidate_allvol is for online array config utilities.  After a
 * utility reconfigures the drives in the array, it can use this function
 * (through an ioctl) to make the driver zap any previous disk structs for
 * that controller and get new ones.
 *
 * Right now I'm using the getgeometry() function to do this, but this
 * function should probably be finer grained and allow you to revalidate one
1162
 * particular logical volume (instead of all of them on a particular
L
Linus Torvalds 已提交
1163 1164 1165 1166 1167 1168 1169
 * controller).
 */
static int revalidate_allvol(ctlr_info_t *host)
{
	int ctlr = host->ctlr, i;
	unsigned long flags;

1170 1171 1172 1173 1174 1175 1176 1177
	spin_lock_irqsave(CCISS_LOCK(ctlr), flags);
	if (host->usage_count > 1) {
		spin_unlock_irqrestore(CCISS_LOCK(ctlr), flags);
		printk(KERN_WARNING "cciss: Device busy for volume"
		       " revalidation (usage=%d)\n", host->usage_count);
		return -EBUSY;
	}
	host->usage_count++;
L
Linus Torvalds 已提交
1178 1179
	spin_unlock_irqrestore(CCISS_LOCK(ctlr), flags);

1180
	for (i = 0; i < NWD; i++) {
L
Linus Torvalds 已提交
1181
		struct gendisk *disk = host->gendisk[i];
1182 1183 1184 1185 1186 1187 1188 1189
		if (disk) {
			request_queue_t *q = disk->queue;

			if (disk->flags & GENHD_FL_UP)
				del_gendisk(disk);
			if (q)
				blk_cleanup_queue(q);
		}
L
Linus Torvalds 已提交
1190 1191
	}

1192 1193 1194 1195 1196 1197 1198 1199 1200 1201 1202 1203 1204 1205 1206 1207
	/*
	 * Set the partition and block size structures for all volumes
	 * on this controller to zero.  We will reread all of this data
	 */
	memset(host->drv, 0, sizeof(drive_info_struct)
	       * CISS_MAX_LUN);
	/*
	 * Tell the array controller not to give us any interrupts while
	 * we check the new geometry.  Then turn interrupts back on when
	 * we're done.
	 */
	host->access.set_intr_mask(host, CCISS_INTR_OFF);
	cciss_getgeometry(ctlr);
	host->access.set_intr_mask(host, CCISS_INTR_ON);

	/* Loop through each real device */
L
Linus Torvalds 已提交
1208 1209 1210 1211 1212 1213 1214
	for (i = 0; i < NWD; i++) {
		struct gendisk *disk = host->gendisk[i];
		drive_info_struct *drv = &(host->drv[i]);
		/* we must register the controller even if no disks exist */
		/* this is for the online array utilities */
		if (!drv->heads && i)
			continue;
M
Mike Miller 已提交
1215
		blk_queue_hardsect_size(drv->queue, drv->block_size);
L
Linus Torvalds 已提交
1216 1217 1218
		set_capacity(disk, drv->nr_blocks);
		add_disk(disk);
	}
1219 1220
	host->usage_count--;
	return 0;
L
Linus Torvalds 已提交
1221 1222
}

1223 1224 1225 1226 1227 1228 1229 1230 1231 1232 1233 1234 1235
static inline void complete_buffers(struct bio *bio, int status)
{
	while (bio) {
		struct bio *xbh = bio->bi_next;
		int nr_sectors = bio_sectors(bio);

		bio->bi_next = NULL;
		blk_finished_io(len);
		bio_endio(bio, nr_sectors << 9, status ? 0 : -EIO);
		bio = xbh;
	}
}

1236 1237 1238 1239 1240 1241 1242 1243 1244 1245 1246 1247 1248 1249 1250 1251 1252 1253 1254 1255 1256 1257 1258 1259 1260 1261 1262 1263 1264 1265 1266 1267 1268 1269 1270 1271 1272 1273 1274 1275 1276 1277 1278 1279
static void cciss_check_queues(ctlr_info_t *h)
{
	int start_queue = h->next_to_run;
	int i;

	/* check to see if we have maxed out the number of commands that can
	 * be placed on the queue.  If so then exit.  We do this check here
	 * in case the interrupt we serviced was from an ioctl and did not
	 * free any new commands.
	 */
	if ((find_first_zero_bit(h->cmd_pool_bits, NR_CMDS)) == NR_CMDS)
		return;

	/* We have room on the queue for more commands.  Now we need to queue
	 * them up.  We will also keep track of the next queue to run so
	 * that every queue gets a chance to be started first.
	 */
	for (i = 0; i < h->highest_lun + 1; i++) {
		int curr_queue = (start_queue + i) % (h->highest_lun + 1);
		/* make sure the disk has been added and the drive is real
		 * because this can be called from the middle of init_one.
		 */
		if (!(h->drv[curr_queue].queue) || !(h->drv[curr_queue].heads))
			continue;
		blk_start_queue(h->gendisk[curr_queue]->queue);

		/* check to see if we have maxed out the number of commands
		 * that can be placed on the queue.
		 */
		if ((find_first_zero_bit(h->cmd_pool_bits, NR_CMDS)) == NR_CMDS) {
			if (curr_queue == start_queue) {
				h->next_to_run =
				    (start_queue + 1) % (h->highest_lun + 1);
				break;
			} else {
				h->next_to_run = curr_queue;
				break;
			}
		} else {
			curr_queue = (curr_queue + 1) % (h->highest_lun + 1);
		}
	}
}

1280 1281 1282 1283 1284 1285 1286 1287 1288 1289 1290 1291 1292 1293 1294
static void cciss_softirq_done(struct request *rq)
{
	CommandList_struct *cmd = rq->completion_data;
	ctlr_info_t *h = hba[cmd->ctlr];
	unsigned long flags;
	u64bit temp64;
	int i, ddir;

	if (cmd->Request.Type.Direction == XFER_READ)
		ddir = PCI_DMA_FROMDEVICE;
	else
		ddir = PCI_DMA_TODEVICE;

	/* command did not need to be retried */
	/* unmap the DMA mapping for all the scatter gather elements */
1295
	for (i = 0; i < cmd->Header.SGList; i++) {
1296 1297 1298 1299 1300 1301 1302 1303 1304
		temp64.val32.lower = cmd->SG[i].Addr.lower;
		temp64.val32.upper = cmd->SG[i].Addr.upper;
		pci_unmap_page(h->pdev, temp64.val, cmd->SG[i].Len, ddir);
	}

	complete_buffers(rq->bio, rq->errors);

#ifdef CCISS_DEBUG
	printk("Done with %p\n", rq);
1305
#endif				/* CCISS_DEBUG */
1306

1307
	add_disk_randomness(rq->rq_disk);
1308 1309
	spin_lock_irqsave(&h->lock, flags);
	end_that_request_last(rq, rq->errors);
1310
	cmd_free(h, cmd, 1);
1311
	cciss_check_queues(h);
1312 1313 1314
	spin_unlock_irqrestore(&h->lock, flags);
}

1315 1316 1317 1318 1319 1320 1321
/* This function will check the usage_count of the drive to be updated/added.
 * If the usage_count is zero then the drive information will be updated and
 * the disk will be re-registered with the kernel.  If not then it will be
 * left alone for the next reboot.  The exception to this is disk 0 which
 * will always be left registered with the kernel since it is also the
 * controller node.  Any changes to disk 0 will show up on the next
 * reboot.
1322
 */
1323
static void cciss_update_drive_info(int ctlr, int drv_index)
1324
{
1325 1326 1327 1328 1329 1330 1331 1332 1333
	ctlr_info_t *h = hba[ctlr];
	struct gendisk *disk;
	ReadCapdata_struct *size_buff = NULL;
	InquiryData_struct *inq_buff = NULL;
	unsigned int block_size;
	unsigned int total_size;
	unsigned long flags = 0;
	int ret = 0;

1334 1335
	/* if the disk already exists then deregister it before proceeding */
	if (h->drv[drv_index].raid_level != -1) {
1336 1337 1338 1339
		spin_lock_irqsave(CCISS_LOCK(h->ctlr), flags);
		h->drv[drv_index].busy_configuring = 1;
		spin_unlock_irqrestore(CCISS_LOCK(h->ctlr), flags);
		ret = deregister_disk(h->gendisk[drv_index],
1340
				      &h->drv[drv_index], 0);
1341 1342 1343 1344 1345 1346 1347
		h->drv[drv_index].busy_configuring = 0;
	}

	/* If the disk is in use return */
	if (ret)
		return;

1348
	/* Get information about the disk and modify the driver structure */
1349 1350
	size_buff = kmalloc(sizeof(ReadCapdata_struct), GFP_KERNEL);
	if (size_buff == NULL)
1351
		goto mem_msg;
1352
	inq_buff = kmalloc(sizeof(InquiryData_struct), GFP_KERNEL);
1353 1354 1355 1356
	if (inq_buff == NULL)
		goto mem_msg;

	cciss_read_capacity(ctlr, drv_index, size_buff, 1,
1357
			    &total_size, &block_size);
1358
	cciss_geometry_inquiry(ctlr, drv_index, 1, total_size, block_size,
1359
			       inq_buff, &h->drv[drv_index]);
1360 1361 1362 1363 1364 1365

	++h->num_luns;
	disk = h->gendisk[drv_index];
	set_capacity(disk, h->drv[drv_index].nr_blocks);

	/* if it's the controller it's already added */
1366
	if (drv_index) {
1367 1368 1369 1370 1371 1372 1373 1374 1375 1376 1377 1378 1379 1380
		disk->queue = blk_init_queue(do_cciss_request, &h->lock);

		/* Set up queue information */
		disk->queue->backing_dev_info.ra_pages = READ_AHEAD;
		blk_queue_bounce_limit(disk->queue, hba[ctlr]->pdev->dma_mask);

		/* This is a hardware imposed limit. */
		blk_queue_max_hw_segments(disk->queue, MAXSGENTRIES);

		/* This is a limit in the driver and could be eliminated. */
		blk_queue_max_phys_segments(disk->queue, MAXSGENTRIES);

		blk_queue_max_sectors(disk->queue, 512);

1381 1382
		blk_queue_softirq_done(disk->queue, cciss_softirq_done);

1383 1384 1385
		disk->queue->queuedata = hba[ctlr];

		blk_queue_hardsect_size(disk->queue,
1386
					hba[ctlr]->drv[drv_index].block_size);
1387 1388 1389 1390 1391

		h->drv[drv_index].queue = disk->queue;
		add_disk(disk);
	}

1392
      freeret:
1393 1394 1395
	kfree(size_buff);
	kfree(inq_buff);
	return;
1396
      mem_msg:
1397 1398 1399 1400 1401 1402 1403 1404 1405
	printk(KERN_ERR "cciss: out of memory\n");
	goto freeret;
}

/* This function will find the first index of the controllers drive array
 * that has a -1 for the raid_level and will return that index.  This is
 * where new drives will be added.  If the index to be returned is greater
 * than the highest_lun index for the controller then highest_lun is set
 * to this new index.  If there are no available indexes then -1 is returned.
1406
 */
1407 1408 1409 1410
static int cciss_find_free_drive_index(int ctlr)
{
	int i;

1411 1412
	for (i = 0; i < CISS_MAX_LUN; i++) {
		if (hba[ctlr]->drv[i].raid_level == -1) {
1413 1414 1415 1416 1417 1418 1419 1420 1421
			if (i > hba[ctlr]->highest_lun)
				hba[ctlr]->highest_lun = i;
			return i;
		}
	}
	return -1;
}

/* This function will add and remove logical drives from the Logical
1422
 * drive array of the controller and maintain persistency of ordering
1423 1424 1425 1426 1427 1428 1429
 * so that mount points are preserved until the next reboot.  This allows
 * for the removal of logical drives in the middle of the drive array
 * without a re-ordering of those drives.
 * INPUT
 * h		= The controller to perform the operations on
 * del_disk	= The disk to remove if specified.  If the value given
 *		  is NULL then no disk is removed.
1430
 */
1431
static int rebuild_lun_table(ctlr_info_t *h, struct gendisk *del_disk)
L
Linus Torvalds 已提交
1432
{
1433 1434 1435 1436 1437 1438 1439 1440 1441 1442
	int ctlr = h->ctlr;
	int num_luns;
	ReportLunData_struct *ld_buff = NULL;
	drive_info_struct *drv = NULL;
	int return_code;
	int listlength = 0;
	int i;
	int drv_found;
	int drv_index = 0;
	__u32 lunid = 0;
L
Linus Torvalds 已提交
1443
	unsigned long flags;
1444 1445 1446

	/* Set busy_configuring flag for this operation */
	spin_lock_irqsave(CCISS_LOCK(h->ctlr), flags);
1447
	if (h->num_luns >= CISS_MAX_LUN) {
1448 1449 1450 1451
		spin_unlock_irqrestore(CCISS_LOCK(h->ctlr), flags);
		return -EINVAL;
	}

1452
	if (h->busy_configuring) {
1453 1454 1455 1456 1457 1458 1459 1460 1461
		spin_unlock_irqrestore(CCISS_LOCK(h->ctlr), flags);
		return -EBUSY;
	}
	h->busy_configuring = 1;

	/* if del_disk is NULL then we are being called to add a new disk
	 * and update the logical drive table.  If it is not NULL then
	 * we will check if the disk is in use or not.
	 */
1462
	if (del_disk != NULL) {
1463 1464 1465 1466 1467 1468 1469 1470 1471 1472 1473 1474 1475 1476 1477 1478 1479
		drv = get_drv(del_disk);
		drv->busy_configuring = 1;
		spin_unlock_irqrestore(CCISS_LOCK(h->ctlr), flags);
		return_code = deregister_disk(del_disk, drv, 1);
		drv->busy_configuring = 0;
		h->busy_configuring = 0;
		return return_code;
	} else {
		spin_unlock_irqrestore(CCISS_LOCK(h->ctlr), flags);
		if (!capable(CAP_SYS_RAWIO))
			return -EPERM;

		ld_buff = kzalloc(sizeof(ReportLunData_struct), GFP_KERNEL);
		if (ld_buff == NULL)
			goto mem_msg;

		return_code = sendcmd_withirq(CISS_REPORT_LOG, ctlr, ld_buff,
1480 1481 1482 1483 1484 1485 1486 1487 1488 1489 1490 1491 1492 1493 1494 1495
					      sizeof(ReportLunData_struct), 0,
					      0, 0, TYPE_CMD);

		if (return_code == IO_OK) {
			listlength |=
			    (0xff & (unsigned int)(ld_buff->LUNListLength[0]))
			    << 24;
			listlength |=
			    (0xff & (unsigned int)(ld_buff->LUNListLength[1]))
			    << 16;
			listlength |=
			    (0xff & (unsigned int)(ld_buff->LUNListLength[2]))
			    << 8;
			listlength |=
			    0xff & (unsigned int)(ld_buff->LUNListLength[3]);
		} else {	/* reading number of logical volumes failed */
1496
			printk(KERN_WARNING "cciss: report logical volume"
1497
			       " command failed\n");
1498 1499 1500 1501 1502
			listlength = 0;
			goto freeret;
		}

		num_luns = listlength / 8;	/* 8 bytes per entry */
1503
		if (num_luns > CISS_MAX_LUN) {
1504 1505
			num_luns = CISS_MAX_LUN;
			printk(KERN_WARNING "cciss: more luns configured"
1506 1507
			       " on controller than can be handled by"
			       " this driver.\n");
1508 1509 1510
		}

		/* Compare controller drive array to drivers drive array.
1511 1512 1513 1514
		 * Check for updates in the drive information and any new drives
		 * on the controller.
		 */
		for (i = 0; i < num_luns; i++) {
1515 1516 1517 1518
			int j;

			drv_found = 0;

1519 1520 1521 1522 1523 1524 1525
			lunid = (0xff &
				 (unsigned int)(ld_buff->LUN[i][3])) << 24;
			lunid |= (0xff &
				  (unsigned int)(ld_buff->LUN[i][2])) << 16;
			lunid |= (0xff &
				  (unsigned int)(ld_buff->LUN[i][1])) << 8;
			lunid |= 0xff & (unsigned int)(ld_buff->LUN[i][0]);
1526 1527 1528 1529 1530

			/* Find if the LUN is already in the drive array
			 * of the controller.  If so then update its info
			 * if not is use.  If it does not exist then find
			 * the first free index and add it.
1531 1532 1533
			 */
			for (j = 0; j <= h->highest_lun; j++) {
				if (h->drv[j].LunID == lunid) {
1534 1535 1536 1537 1538 1539
					drv_index = j;
					drv_found = 1;
				}
			}

			/* check if the drive was found already in the array */
1540
			if (!drv_found) {
1541 1542 1543 1544 1545 1546 1547
				drv_index = cciss_find_free_drive_index(ctlr);
				if (drv_index == -1)
					goto freeret;

			}
			h->drv[drv_index].LunID = lunid;
			cciss_update_drive_info(ctlr, drv_index);
1548 1549
		}		/* end for */
	}			/* end else */
1550

1551
      freeret:
1552 1553 1554 1555 1556
	kfree(ld_buff);
	h->busy_configuring = 0;
	/* We return -1 here to tell the ACU that we have registered/updated
	 * all of the drives that we can and to keep it from calling us
	 * additional times.
1557
	 */
1558
	return -1;
1559
      mem_msg:
1560 1561 1562 1563 1564 1565 1566 1567 1568 1569 1570 1571 1572 1573 1574
	printk(KERN_ERR "cciss: out of memory\n");
	goto freeret;
}

/* This function will deregister the disk and it's queue from the
 * kernel.  It must be called with the controller lock held and the
 * drv structures busy_configuring flag set.  It's parameters are:
 *
 * disk = This is the disk to be deregistered
 * drv  = This is the drive_info_struct associated with the disk to be
 *        deregistered.  It contains information about the disk used
 *        by the driver.
 * clear_all = This flag determines whether or not the disk information
 *             is going to be completely cleared out and the highest_lun
 *             reset.  Sometimes we want to clear out information about
1575
 *             the disk in preparation for re-adding it.  In this case
1576 1577 1578 1579 1580 1581
 *             the highest_lun should be left unchanged and the LunID
 *             should not be cleared.
*/
static int deregister_disk(struct gendisk *disk, drive_info_struct *drv,
			   int clear_all)
{
L
Linus Torvalds 已提交
1582 1583 1584 1585 1586 1587
	ctlr_info_t *h = get_host(disk);

	if (!capable(CAP_SYS_RAWIO))
		return -EPERM;

	/* make sure logical volume is NOT is use */
1588 1589 1590 1591 1592
	if (clear_all || (h->gendisk[0] == disk)) {
		if (drv->usage_count > 1)
			return -EBUSY;
	} else if (drv->usage_count > 0)
		return -EBUSY;
L
Linus Torvalds 已提交
1593

1594 1595 1596
	/* invalidate the devices and deregister the disk.  If it is disk
	 * zero do not deregister it but just zero out it's values.  This
	 * allows us to delete disk zero but keep the controller registered.
1597 1598
	 */
	if (h->gendisk[0] != disk) {
1599 1600 1601 1602
		if (disk) {
			request_queue_t *q = disk->queue;
			if (disk->flags & GENHD_FL_UP)
				del_gendisk(disk);
1603
			if (q) {
1604
				blk_cleanup_queue(q);
1605 1606
				drv->queue = NULL;
			}
1607 1608 1609 1610 1611 1612 1613 1614 1615 1616 1617 1618 1619
		}
	}

	--h->num_luns;
	/* zero out the disk size info */
	drv->nr_blocks = 0;
	drv->block_size = 0;
	drv->heads = 0;
	drv->sectors = 0;
	drv->cylinders = 0;
	drv->raid_level = -1;	/* This can be used as a flag variable to
				 * indicate that this element of the drive
				 * array is free.
1620 1621 1622 1623 1624 1625 1626 1627 1628
				 */

	if (clear_all) {
		/* check to see if it was the last disk */
		if (drv == h->drv + h->highest_lun) {
			/* if so, find the new hightest lun */
			int i, newhighest = -1;
			for (i = 0; i < h->highest_lun; i++) {
				/* if the disk has size > 0, it is available */
1629
				if (h->drv[i].heads)
1630 1631 1632
					newhighest = i;
			}
			h->highest_lun = newhighest;
L
Linus Torvalds 已提交
1633
		}
1634

1635
		drv->LunID = 0;
1636
	}
1637
	return 0;
L
Linus Torvalds 已提交
1638
}
1639

1640 1641 1642 1643 1644
static int fill_cmd(CommandList_struct *c, __u8 cmd, int ctlr, void *buff, size_t size, unsigned int use_unit_num,	/* 0: address the controller,
															   1: address logical volume log_unit,
															   2: periph device address is scsi3addr */
		    unsigned int log_unit, __u8 page_code,
		    unsigned char *scsi3addr, int cmd_type)
L
Linus Torvalds 已提交
1645
{
1646
	ctlr_info_t *h = hba[ctlr];
L
Linus Torvalds 已提交
1647 1648 1649 1650 1651
	u64bit buff_dma_handle;
	int status = IO_OK;

	c->cmd_type = CMD_IOCTL_PEND;
	c->Header.ReplyQueue = 0;
1652
	if (buff != NULL) {
L
Linus Torvalds 已提交
1653
		c->Header.SGList = 1;
1654
		c->Header.SGTotal = 1;
L
Linus Torvalds 已提交
1655 1656
	} else {
		c->Header.SGList = 0;
1657
		c->Header.SGTotal = 0;
L
Linus Torvalds 已提交
1658 1659 1660 1661 1662
	}
	c->Header.Tag.lower = c->busaddr;

	c->Request.Type.Type = cmd_type;
	if (cmd_type == TYPE_CMD) {
1663 1664
		switch (cmd) {
		case CISS_INQUIRY:
L
Linus Torvalds 已提交
1665
			/* If the logical unit number is 0 then, this is going
1666 1667 1668 1669 1670 1671
			   to controller so It's a physical command
			   mode = 0 target = 0.  So we have nothing to write.
			   otherwise, if use_unit_num == 1,
			   mode = 1(volume set addressing) target = LUNID
			   otherwise, if use_unit_num == 2,
			   mode = 0(periph dev addr) target = scsi3addr */
L
Linus Torvalds 已提交
1672
			if (use_unit_num == 1) {
1673 1674 1675
				c->Header.LUN.LogDev.VolId =
				    h->drv[log_unit].LunID;
				c->Header.LUN.LogDev.Mode = 1;
L
Linus Torvalds 已提交
1676
			} else if (use_unit_num == 2) {
1677 1678
				memcpy(c->Header.LUN.LunAddrBytes, scsi3addr,
				       8);
L
Linus Torvalds 已提交
1679 1680 1681
				c->Header.LUN.LogDev.Mode = 0;
			}
			/* are we trying to read a vital product page */
1682
			if (page_code != 0) {
L
Linus Torvalds 已提交
1683 1684 1685 1686
				c->Request.CDB[1] = 0x01;
				c->Request.CDB[2] = page_code;
			}
			c->Request.CDBLen = 6;
1687
			c->Request.Type.Attribute = ATTR_SIMPLE;
L
Linus Torvalds 已提交
1688 1689
			c->Request.Type.Direction = XFER_READ;
			c->Request.Timeout = 0;
1690 1691 1692
			c->Request.CDB[0] = CISS_INQUIRY;
			c->Request.CDB[4] = size & 0xFF;
			break;
L
Linus Torvalds 已提交
1693 1694
		case CISS_REPORT_LOG:
		case CISS_REPORT_PHYS:
1695
			/* Talking to controller so It's a physical command
L
Linus Torvalds 已提交
1696
			   mode = 00 target = 0.  Nothing to write.
1697
			 */
L
Linus Torvalds 已提交
1698 1699 1700 1701 1702
			c->Request.CDBLen = 12;
			c->Request.Type.Attribute = ATTR_SIMPLE;
			c->Request.Type.Direction = XFER_READ;
			c->Request.Timeout = 0;
			c->Request.CDB[0] = cmd;
1703
			c->Request.CDB[6] = (size >> 24) & 0xFF;	//MSB
L
Linus Torvalds 已提交
1704 1705 1706 1707 1708 1709 1710 1711 1712 1713 1714 1715 1716
			c->Request.CDB[7] = (size >> 16) & 0xFF;
			c->Request.CDB[8] = (size >> 8) & 0xFF;
			c->Request.CDB[9] = size & 0xFF;
			break;

		case CCISS_READ_CAPACITY:
			c->Header.LUN.LogDev.VolId = h->drv[log_unit].LunID;
			c->Header.LUN.LogDev.Mode = 1;
			c->Request.CDBLen = 10;
			c->Request.Type.Attribute = ATTR_SIMPLE;
			c->Request.Type.Direction = XFER_READ;
			c->Request.Timeout = 0;
			c->Request.CDB[0] = cmd;
1717
			break;
L
Linus Torvalds 已提交
1718 1719 1720 1721 1722 1723 1724
		case CCISS_CACHE_FLUSH:
			c->Request.CDBLen = 12;
			c->Request.Type.Attribute = ATTR_SIMPLE;
			c->Request.Type.Direction = XFER_WRITE;
			c->Request.Timeout = 0;
			c->Request.CDB[0] = BMIC_WRITE;
			c->Request.CDB[6] = BMIC_CACHE_FLUSH;
1725
			break;
L
Linus Torvalds 已提交
1726 1727
		default:
			printk(KERN_WARNING
1728
			       "cciss%d:  Unknown Command 0x%c\n", ctlr, cmd);
1729
			return IO_ERROR;
L
Linus Torvalds 已提交
1730 1731 1732
		}
	} else if (cmd_type == TYPE_MSG) {
		switch (cmd) {
1733
		case 0:	/* ABORT message */
1734 1735 1736 1737
			c->Request.CDBLen = 12;
			c->Request.Type.Attribute = ATTR_SIMPLE;
			c->Request.Type.Direction = XFER_WRITE;
			c->Request.Timeout = 0;
1738 1739
			c->Request.CDB[0] = cmd;	/* abort */
			c->Request.CDB[1] = 0;	/* abort a command */
1740 1741 1742
			/* buff contains the tag of the command to abort */
			memcpy(&c->Request.CDB[4], buff, 8);
			break;
1743
		case 1:	/* RESET message */
1744 1745 1746 1747 1748
			c->Request.CDBLen = 12;
			c->Request.Type.Attribute = ATTR_SIMPLE;
			c->Request.Type.Direction = XFER_WRITE;
			c->Request.Timeout = 0;
			memset(&c->Request.CDB[0], 0, sizeof(c->Request.CDB));
1749 1750
			c->Request.CDB[0] = cmd;	/* reset */
			c->Request.CDB[1] = 0x04;	/* reset a LUN */
L
Linus Torvalds 已提交
1751 1752 1753 1754 1755 1756 1757 1758 1759
		case 3:	/* No-Op message */
			c->Request.CDBLen = 1;
			c->Request.Type.Attribute = ATTR_SIMPLE;
			c->Request.Type.Direction = XFER_WRITE;
			c->Request.Timeout = 0;
			c->Request.CDB[0] = cmd;
			break;
		default:
			printk(KERN_WARNING
1760
			       "cciss%d: unknown message type %d\n", ctlr, cmd);
L
Linus Torvalds 已提交
1761 1762 1763 1764
			return IO_ERROR;
		}
	} else {
		printk(KERN_WARNING
1765
		       "cciss%d: unknown command type %d\n", ctlr, cmd_type);
L
Linus Torvalds 已提交
1766 1767 1768 1769 1770
		return IO_ERROR;
	}
	/* Fill in the scatter gather information */
	if (size > 0) {
		buff_dma_handle.val = (__u64) pci_map_single(h->pdev,
1771 1772
							     buff, size,
							     PCI_DMA_BIDIRECTIONAL);
L
Linus Torvalds 已提交
1773 1774 1775
		c->SG[0].Addr.lower = buff_dma_handle.val32.lower;
		c->SG[0].Addr.upper = buff_dma_handle.val32.upper;
		c->SG[0].Len = size;
1776
		c->SG[0].Ext = 0;	/* we are not chaining */
L
Linus Torvalds 已提交
1777 1778 1779
	}
	return status;
}
1780 1781 1782 1783 1784 1785 1786

static int sendcmd_withirq(__u8 cmd,
			   int ctlr,
			   void *buff,
			   size_t size,
			   unsigned int use_unit_num,
			   unsigned int log_unit, __u8 page_code, int cmd_type)
L
Linus Torvalds 已提交
1787 1788 1789
{
	ctlr_info_t *h = hba[ctlr];
	CommandList_struct *c;
1790
	u64bit buff_dma_handle;
L
Linus Torvalds 已提交
1791 1792 1793
	unsigned long flags;
	int return_status;
	DECLARE_COMPLETION(wait);
1794 1795

	if ((c = cmd_alloc(h, 0)) == NULL)
L
Linus Torvalds 已提交
1796 1797
		return -ENOMEM;
	return_status = fill_cmd(c, cmd, ctlr, buff, size, use_unit_num,
1798
				 log_unit, page_code, NULL, cmd_type);
L
Linus Torvalds 已提交
1799 1800 1801 1802
	if (return_status != IO_OK) {
		cmd_free(h, c, 0);
		return return_status;
	}
1803
      resend_cmd2:
L
Linus Torvalds 已提交
1804
	c->waiting = &wait;
1805

L
Linus Torvalds 已提交
1806 1807 1808 1809 1810 1811
	/* Put the request on the tail of the queue and send it */
	spin_lock_irqsave(CCISS_LOCK(ctlr), flags);
	addQ(&h->reqQ, c);
	h->Qdepth++;
	start_io(h);
	spin_unlock_irqrestore(CCISS_LOCK(ctlr), flags);
1812

L
Linus Torvalds 已提交
1813 1814
	wait_for_completion(&wait);

1815 1816 1817 1818 1819 1820 1821 1822 1823 1824
	if (c->err_info->CommandStatus != 0) {	/* an error has occurred */
		switch (c->err_info->CommandStatus) {
		case CMD_TARGET_STATUS:
			printk(KERN_WARNING "cciss: cmd %p has "
			       " completed with errors\n", c);
			if (c->err_info->ScsiStatus) {
				printk(KERN_WARNING "cciss: cmd %p "
				       "has SCSI Status = %x\n",
				       c, c->err_info->ScsiStatus);
			}
L
Linus Torvalds 已提交
1825 1826

			break;
1827 1828
		case CMD_DATA_UNDERRUN:
		case CMD_DATA_OVERRUN:
L
Linus Torvalds 已提交
1829 1830
			/* expected for inquire and report lun commands */
			break;
1831 1832 1833 1834
		case CMD_INVALID:
			printk(KERN_WARNING "cciss: Cmd %p is "
			       "reported invalid\n", c);
			return_status = IO_ERROR;
L
Linus Torvalds 已提交
1835
			break;
1836 1837 1838 1839
		case CMD_PROTOCOL_ERR:
			printk(KERN_WARNING "cciss: cmd %p has "
			       "protocol error \n", c);
			return_status = IO_ERROR;
L
Linus Torvalds 已提交
1840
			break;
1841 1842 1843 1844
		case CMD_HARDWARE_ERR:
			printk(KERN_WARNING "cciss: cmd %p had "
			       " hardware error\n", c);
			return_status = IO_ERROR;
L
Linus Torvalds 已提交
1845
			break;
1846 1847 1848 1849
		case CMD_CONNECTION_LOST:
			printk(KERN_WARNING "cciss: cmd %p had "
			       "connection lost\n", c);
			return_status = IO_ERROR;
L
Linus Torvalds 已提交
1850
			break;
1851 1852 1853 1854
		case CMD_ABORTED:
			printk(KERN_WARNING "cciss: cmd %p was "
			       "aborted\n", c);
			return_status = IO_ERROR;
L
Linus Torvalds 已提交
1855
			break;
1856 1857 1858 1859 1860 1861 1862 1863 1864 1865 1866 1867 1868 1869 1870 1871 1872 1873 1874 1875 1876 1877 1878 1879 1880 1881
		case CMD_ABORT_FAILED:
			printk(KERN_WARNING "cciss: cmd %p reports "
			       "abort failed\n", c);
			return_status = IO_ERROR;
			break;
		case CMD_UNSOLICITED_ABORT:
			printk(KERN_WARNING
			       "cciss%d: unsolicited abort %p\n", ctlr, c);
			if (c->retry_count < MAX_CMD_RETRIES) {
				printk(KERN_WARNING
				       "cciss%d: retrying %p\n", ctlr, c);
				c->retry_count++;
				/* erase the old error information */
				memset(c->err_info, 0,
				       sizeof(ErrorInfo_struct));
				return_status = IO_OK;
				INIT_COMPLETION(wait);
				goto resend_cmd2;
			}
			return_status = IO_ERROR;
			break;
		default:
			printk(KERN_WARNING "cciss: cmd %p returned "
			       "unknown status %x\n", c,
			       c->err_info->CommandStatus);
			return_status = IO_ERROR;
L
Linus Torvalds 已提交
1882
		}
1883
	}
L
Linus Torvalds 已提交
1884
	/* unlock the buffers from DMA */
1885 1886
	buff_dma_handle.val32.lower = c->SG[0].Addr.lower;
	buff_dma_handle.val32.upper = c->SG[0].Addr.upper;
1887 1888
	pci_unmap_single(h->pdev, (dma_addr_t) buff_dma_handle.val,
			 c->SG[0].Len, PCI_DMA_BIDIRECTIONAL);
L
Linus Torvalds 已提交
1889
	cmd_free(h, c, 0);
1890
	return return_status;
L
Linus Torvalds 已提交
1891
}
1892

L
Linus Torvalds 已提交
1893
static void cciss_geometry_inquiry(int ctlr, int logvol,
1894 1895 1896 1897
				   int withirq, unsigned int total_size,
				   unsigned int block_size,
				   InquiryData_struct *inq_buff,
				   drive_info_struct *drv)
L
Linus Torvalds 已提交
1898 1899 1900 1901 1902
{
	int return_code;
	memset(inq_buff, 0, sizeof(InquiryData_struct));
	if (withirq)
		return_code = sendcmd_withirq(CISS_INQUIRY, ctlr,
1903 1904
					      inq_buff, sizeof(*inq_buff), 1,
					      logvol, 0xC1, TYPE_CMD);
L
Linus Torvalds 已提交
1905 1906
	else
		return_code = sendcmd(CISS_INQUIRY, ctlr, inq_buff,
1907 1908
				      sizeof(*inq_buff), 1, logvol, 0xC1, NULL,
				      TYPE_CMD);
L
Linus Torvalds 已提交
1909
	if (return_code == IO_OK) {
1910
		if (inq_buff->data_byte[8] == 0xFF) {
L
Linus Torvalds 已提交
1911
			printk(KERN_WARNING
1912 1913
			       "cciss: reading geometry failed, volume "
			       "does not support reading geometry\n");
L
Linus Torvalds 已提交
1914 1915 1916
			drv->block_size = block_size;
			drv->nr_blocks = total_size;
			drv->heads = 255;
1917
			drv->sectors = 32;	// Sectors per track
L
Linus Torvalds 已提交
1918 1919 1920 1921 1922 1923 1924 1925 1926 1927 1928 1929 1930
			drv->cylinders = total_size / 255 / 32;
		} else {
			unsigned int t;

			drv->block_size = block_size;
			drv->nr_blocks = total_size;
			drv->heads = inq_buff->data_byte[6];
			drv->sectors = inq_buff->data_byte[7];
			drv->cylinders = (inq_buff->data_byte[4] & 0xff) << 8;
			drv->cylinders += inq_buff->data_byte[5];
			drv->raid_level = inq_buff->data_byte[8];
			t = drv->heads * drv->sectors;
			if (t > 1) {
1931
				drv->cylinders = total_size / t;
L
Linus Torvalds 已提交
1932 1933
			}
		}
1934
	} else {		/* Get geometry failed */
L
Linus Torvalds 已提交
1935 1936 1937
		printk(KERN_WARNING "cciss: reading geometry failed\n");
	}
	printk(KERN_INFO "      heads= %d, sectors= %d, cylinders= %d\n\n",
1938
	       drv->heads, drv->sectors, drv->cylinders);
L
Linus Torvalds 已提交
1939
}
1940

L
Linus Torvalds 已提交
1941 1942
static void
cciss_read_capacity(int ctlr, int logvol, ReadCapdata_struct *buf,
1943 1944
		    int withirq, unsigned int *total_size,
		    unsigned int *block_size)
L
Linus Torvalds 已提交
1945 1946 1947 1948 1949
{
	int return_code;
	memset(buf, 0, sizeof(*buf));
	if (withirq)
		return_code = sendcmd_withirq(CCISS_READ_CAPACITY,
1950 1951
					      ctlr, buf, sizeof(*buf), 1,
					      logvol, 0, TYPE_CMD);
L
Linus Torvalds 已提交
1952 1953
	else
		return_code = sendcmd(CCISS_READ_CAPACITY,
1954 1955
				      ctlr, buf, sizeof(*buf), 1, logvol, 0,
				      NULL, TYPE_CMD);
L
Linus Torvalds 已提交
1956
	if (return_code == IO_OK) {
1957 1958 1959 1960
		*total_size =
		    be32_to_cpu(*((__be32 *) & buf->total_size[0])) + 1;
		*block_size = be32_to_cpu(*((__be32 *) & buf->block_size[0]));
	} else {		/* read capacity command failed */
L
Linus Torvalds 已提交
1961 1962 1963 1964 1965
		printk(KERN_WARNING "cciss: read capacity failed\n");
		*total_size = 0;
		*block_size = BLOCK_SIZE;
	}
	printk(KERN_INFO "      blocks= %u block_size= %d\n",
1966
	       *total_size, *block_size);
L
Linus Torvalds 已提交
1967 1968 1969 1970 1971 1972 1973 1974
	return;
}

static int cciss_revalidate(struct gendisk *disk)
{
	ctlr_info_t *h = get_host(disk);
	drive_info_struct *drv = get_drv(disk);
	int logvol;
1975
	int FOUND = 0;
L
Linus Torvalds 已提交
1976 1977 1978 1979 1980
	unsigned int block_size;
	unsigned int total_size;
	ReadCapdata_struct *size_buff = NULL;
	InquiryData_struct *inq_buff = NULL;

1981 1982 1983
	for (logvol = 0; logvol < CISS_MAX_LUN; logvol++) {
		if (h->drv[logvol].LunID == drv->LunID) {
			FOUND = 1;
L
Linus Torvalds 已提交
1984 1985 1986 1987
			break;
		}
	}

1988 1989
	if (!FOUND)
		return 1;
L
Linus Torvalds 已提交
1990

1991 1992 1993 1994 1995 1996 1997 1998
	size_buff = kmalloc(sizeof(ReadCapdata_struct), GFP_KERNEL);
	if (size_buff == NULL) {
		printk(KERN_WARNING "cciss: out of memory\n");
		return 1;
	}
	inq_buff = kmalloc(sizeof(InquiryData_struct), GFP_KERNEL);
	if (inq_buff == NULL) {
		printk(KERN_WARNING "cciss: out of memory\n");
L
Linus Torvalds 已提交
1999
		kfree(size_buff);
2000 2001
		return 1;
	}
L
Linus Torvalds 已提交
2002

2003 2004 2005 2006
	cciss_read_capacity(h->ctlr, logvol, size_buff, 1, &total_size,
			    &block_size);
	cciss_geometry_inquiry(h->ctlr, logvol, 1, total_size, block_size,
			       inq_buff, drv);
L
Linus Torvalds 已提交
2007

M
Mike Miller 已提交
2008
	blk_queue_hardsect_size(drv->queue, drv->block_size);
L
Linus Torvalds 已提交
2009 2010 2011 2012 2013 2014 2015 2016 2017 2018 2019 2020 2021 2022 2023 2024 2025 2026 2027 2028 2029
	set_capacity(disk, drv->nr_blocks);

	kfree(size_buff);
	kfree(inq_buff);
	return 0;
}

/*
 *   Wait polling for a command to complete.
 *   The memory mapped FIFO is polled for the completion.
 *   Used only at init time, interrupts from the HBA are disabled.
 */
static unsigned long pollcomplete(int ctlr)
{
	unsigned long done;
	int i;

	/* Wait (up to 20 seconds) for a command to complete */

	for (i = 20 * HZ; i > 0; i--) {
		done = hba[ctlr]->access.command_completed(hba[ctlr]);
2030 2031 2032
		if (done == FIFO_EMPTY)
			schedule_timeout_uninterruptible(1);
		else
2033
			return done;
L
Linus Torvalds 已提交
2034 2035 2036 2037
	}
	/* Invalid address to tell caller we ran out of time */
	return 1;
}
2038 2039 2040 2041

static int add_sendcmd_reject(__u8 cmd, int ctlr, unsigned long complete)
{
	/* We get in here if sendcmd() is polling for completions
2042 2043 2044
	   and gets some command back that it wasn't expecting --
	   something other than that which it just sent down.
	   Ordinarily, that shouldn't happen, but it can happen when
2045
	   the scsi tape stuff gets into error handling mode, and
2046
	   starts using sendcmd() to try to abort commands and
2047 2048
	   reset tape drives.  In that case, sendcmd may pick up
	   completions of commands that were sent to logical drives
2049
	   through the block i/o system, or cciss ioctls completing, etc.
2050 2051
	   In that case, we need to save those completions for later
	   processing by the interrupt handler.
2052
	 */
2053 2054

#ifdef CONFIG_CISS_SCSI_TAPE
2055
	struct sendcmd_reject_list *srl = &hba[ctlr]->scsi_rejects;
2056 2057 2058 2059 2060

	/* If it's not the scsi tape stuff doing error handling, (abort */
	/* or reset) then we don't expect anything weird. */
	if (cmd != CCISS_RESET_MSG && cmd != CCISS_ABORT_MSG) {
#endif
2061 2062 2063
		printk(KERN_WARNING "cciss cciss%d: SendCmd "
		       "Invalid command list address returned! (%lx)\n",
		       ctlr, complete);
2064 2065 2066 2067 2068 2069 2070 2071 2072 2073
		/* not much we can do. */
#ifdef CONFIG_CISS_SCSI_TAPE
		return 1;
	}

	/* We've sent down an abort or reset, but something else
	   has completed */
	if (srl->ncompletions >= (NR_CMDS + 2)) {
		/* Uh oh.  No room to save it for later... */
		printk(KERN_WARNING "cciss%d: Sendcmd: Invalid command addr, "
2074
		       "reject list overflow, command lost!\n", ctlr);
2075 2076 2077 2078 2079 2080 2081 2082 2083
		return 1;
	}
	/* Save it for later */
	srl->complete[srl->ncompletions] = complete;
	srl->ncompletions++;
#endif
	return 0;
}

L
Linus Torvalds 已提交
2084
/*
2085 2086
 * Send a command to the controller, and wait for it to complete.
 * Only used at init time.
L
Linus Torvalds 已提交
2087
 */
2088 2089 2090 2091 2092
static int sendcmd(__u8 cmd, int ctlr, void *buff, size_t size, unsigned int use_unit_num,	/* 0: address the controller,
												   1: address logical volume log_unit,
												   2: periph device address is scsi3addr */
		   unsigned int log_unit,
		   __u8 page_code, unsigned char *scsi3addr, int cmd_type)
L
Linus Torvalds 已提交
2093 2094 2095 2096
{
	CommandList_struct *c;
	int i;
	unsigned long complete;
2097
	ctlr_info_t *info_p = hba[ctlr];
L
Linus Torvalds 已提交
2098
	u64bit buff_dma_handle;
2099
	int status, done = 0;
L
Linus Torvalds 已提交
2100 2101 2102

	if ((c = cmd_alloc(info_p, 1)) == NULL) {
		printk(KERN_WARNING "cciss: unable to get memory");
2103
		return IO_ERROR;
L
Linus Torvalds 已提交
2104 2105
	}
	status = fill_cmd(c, cmd, ctlr, buff, size, use_unit_num,
2106
			  log_unit, page_code, scsi3addr, cmd_type);
L
Linus Torvalds 已提交
2107 2108 2109 2110
	if (status != IO_OK) {
		cmd_free(info_p, c, 1);
		return status;
	}
2111
      resend_cmd1:
L
Linus Torvalds 已提交
2112
	/*
2113 2114
	 * Disable interrupt
	 */
L
Linus Torvalds 已提交
2115 2116
#ifdef CCISS_DEBUG
	printk(KERN_DEBUG "cciss: turning intr off\n");
2117 2118 2119
#endif				/* CCISS_DEBUG */
	info_p->access.set_intr_mask(info_p, CCISS_INTR_OFF);

L
Linus Torvalds 已提交
2120
	/* Make sure there is room in the command FIFO */
2121
	/* Actually it should be completely empty at this time */
2122 2123
	/* unless we are in here doing error handling for the scsi */
	/* tape side of the driver. */
2124
	for (i = 200000; i > 0; i--) {
L
Linus Torvalds 已提交
2125
		/* if fifo isn't full go */
2126 2127 2128 2129 2130 2131 2132 2133 2134 2135 2136 2137
		if (!(info_p->access.fifo_full(info_p))) {

			break;
		}
		udelay(10);
		printk(KERN_WARNING "cciss cciss%d: SendCmd FIFO full,"
		       " waiting!\n", ctlr);
	}
	/*
	 * Send the cmd
	 */
	info_p->access.submit_command(info_p, c);
2138 2139 2140
	done = 0;
	do {
		complete = pollcomplete(ctlr);
L
Linus Torvalds 已提交
2141 2142

#ifdef CCISS_DEBUG
2143
		printk(KERN_DEBUG "cciss: command completed\n");
2144
#endif				/* CCISS_DEBUG */
L
Linus Torvalds 已提交
2145

2146
		if (complete == 1) {
2147 2148 2149
			printk(KERN_WARNING
			       "cciss cciss%d: SendCmd Timeout out, "
			       "No command list address returned!\n", ctlr);
2150 2151 2152 2153 2154 2155
			status = IO_ERROR;
			done = 1;
			break;
		}

		/* This will need to change for direct lookup completions */
2156 2157 2158 2159 2160
		if ((complete & CISS_ERROR_BIT)
		    && (complete & ~CISS_ERROR_BIT) == c->busaddr) {
			/* if data overrun or underun on Report command
			   ignore it
			 */
L
Linus Torvalds 已提交
2161 2162 2163
			if (((c->Request.CDB[0] == CISS_REPORT_LOG) ||
			     (c->Request.CDB[0] == CISS_REPORT_PHYS) ||
			     (c->Request.CDB[0] == CISS_INQUIRY)) &&
2164 2165 2166 2167
			    ((c->err_info->CommandStatus ==
			      CMD_DATA_OVERRUN) ||
			     (c->err_info->CommandStatus == CMD_DATA_UNDERRUN)
			    )) {
L
Linus Torvalds 已提交
2168 2169 2170
				complete = c->busaddr;
			} else {
				if (c->err_info->CommandStatus ==
2171
				    CMD_UNSOLICITED_ABORT) {
L
Linus Torvalds 已提交
2172
					printk(KERN_WARNING "cciss%d: "
2173 2174
					       "unsolicited abort %p\n",
					       ctlr, c);
L
Linus Torvalds 已提交
2175 2176
					if (c->retry_count < MAX_CMD_RETRIES) {
						printk(KERN_WARNING
2177 2178
						       "cciss%d: retrying %p\n",
						       ctlr, c);
L
Linus Torvalds 已提交
2179 2180 2181 2182
						c->retry_count++;
						/* erase the old error */
						/* information */
						memset(c->err_info, 0,
2183 2184
						       sizeof
						       (ErrorInfo_struct));
L
Linus Torvalds 已提交
2185 2186 2187
						goto resend_cmd1;
					} else {
						printk(KERN_WARNING
2188 2189
						       "cciss%d: retried %p too "
						       "many times\n", ctlr, c);
L
Linus Torvalds 已提交
2190 2191 2192
						status = IO_ERROR;
						goto cleanup1;
					}
2193 2194 2195 2196 2197
				} else if (c->err_info->CommandStatus ==
					   CMD_UNABORTABLE) {
					printk(KERN_WARNING
					       "cciss%d: command could not be aborted.\n",
					       ctlr);
2198 2199
					status = IO_ERROR;
					goto cleanup1;
L
Linus Torvalds 已提交
2200 2201
				}
				printk(KERN_WARNING "ciss ciss%d: sendcmd"
2202 2203
				       " Error %x \n", ctlr,
				       c->err_info->CommandStatus);
L
Linus Torvalds 已提交
2204
				printk(KERN_WARNING "ciss ciss%d: sendcmd"
2205 2206 2207 2208 2209 2210 2211 2212 2213
				       " offensive info\n"
				       "  size %x\n   num %x   value %x\n",
				       ctlr,
				       c->err_info->MoreErrInfo.Invalid_Cmd.
				       offense_size,
				       c->err_info->MoreErrInfo.Invalid_Cmd.
				       offense_num,
				       c->err_info->MoreErrInfo.Invalid_Cmd.
				       offense_value);
L
Linus Torvalds 已提交
2214 2215 2216 2217
				status = IO_ERROR;
				goto cleanup1;
			}
		}
2218
		/* This will need changing for direct lookup completions */
2219
		if (complete != c->busaddr) {
2220
			if (add_sendcmd_reject(cmd, ctlr, complete) != 0) {
2221
				BUG();	/* we are pretty much hosed if we get here. */
2222 2223
			}
			continue;
2224
		} else
2225
			done = 1;
2226 2227 2228
	} while (!done);

      cleanup1:
L
Linus Torvalds 已提交
2229
	/* unlock the data buffer from DMA */
2230 2231
	buff_dma_handle.val32.lower = c->SG[0].Addr.lower;
	buff_dma_handle.val32.upper = c->SG[0].Addr.upper;
L
Linus Torvalds 已提交
2232
	pci_unmap_single(info_p->pdev, (dma_addr_t) buff_dma_handle.val,
2233
			 c->SG[0].Len, PCI_DMA_BIDIRECTIONAL);
2234 2235 2236 2237 2238
#ifdef CONFIG_CISS_SCSI_TAPE
	/* if we saved some commands for later, process them now. */
	if (info_p->scsi_rejects.ncompletions > 0)
		do_cciss_intr(0, info_p, NULL);
#endif
L
Linus Torvalds 已提交
2239
	cmd_free(info_p, c, 1);
2240
	return status;
2241 2242
}

L
Linus Torvalds 已提交
2243 2244 2245 2246 2247
/*
 * Map (physical) PCI mem into (virtual) kernel space
 */
static void __iomem *remap_pci_mem(ulong base, ulong size)
{
2248 2249 2250
	ulong page_base = ((ulong) base) & PAGE_MASK;
	ulong page_offs = ((ulong) base) - page_base;
	void __iomem *page_remapped = ioremap(page_base, page_offs + size);
L
Linus Torvalds 已提交
2251

2252
	return page_remapped ? (page_remapped + page_offs) : NULL;
L
Linus Torvalds 已提交
2253 2254
}

2255 2256 2257 2258 2259
/*
 * Takes jobs of the Q and sends them to the hardware, then puts it on
 * the Q to wait for completion.
 */
static void start_io(ctlr_info_t *h)
L
Linus Torvalds 已提交
2260 2261
{
	CommandList_struct *c;
2262 2263

	while ((c = h->reqQ) != NULL) {
L
Linus Torvalds 已提交
2264 2265 2266 2267 2268 2269
		/* can't do anything if fifo is full */
		if ((h->access.fifo_full(h))) {
			printk(KERN_WARNING "cciss: fifo full\n");
			break;
		}

2270
		/* Get the first entry from the Request Q */
L
Linus Torvalds 已提交
2271 2272
		removeQ(&(h->reqQ), c);
		h->Qdepth--;
2273 2274

		/* Tell the controller execute command */
L
Linus Torvalds 已提交
2275
		h->access.submit_command(h, c);
2276 2277 2278

		/* Put job onto the completed Q */
		addQ(&(h->cmpQ), c);
L
Linus Torvalds 已提交
2279 2280
	}
}
2281

L
Linus Torvalds 已提交
2282 2283 2284
/* Assumes that CCISS_LOCK(h->ctlr) is held. */
/* Zeros out the error record and then resends the command back */
/* to the controller */
2285
static inline void resend_cciss_cmd(ctlr_info_t *h, CommandList_struct *c)
L
Linus Torvalds 已提交
2286 2287 2288 2289 2290
{
	/* erase the old error information */
	memset(c->err_info, 0, sizeof(ErrorInfo_struct));

	/* add it to software queue and then send it to the controller */
2291
	addQ(&(h->reqQ), c);
L
Linus Torvalds 已提交
2292
	h->Qdepth++;
2293
	if (h->Qdepth > h->maxQsinceinit)
L
Linus Torvalds 已提交
2294 2295 2296 2297
		h->maxQsinceinit = h->Qdepth;

	start_io(h);
}
2298

2299
/* checks the status of the job and calls complete buffers to mark all
2300 2301
 * buffers for the completed job. Note that this function does not need
 * to hold the hba/queue lock.
2302 2303 2304
 */
static inline void complete_command(ctlr_info_t *h, CommandList_struct *cmd,
				    int timeout)
L
Linus Torvalds 已提交
2305 2306 2307
{
	int status = 1;
	int retry_cmd = 0;
2308

L
Linus Torvalds 已提交
2309
	if (timeout)
2310
		status = 0;
L
Linus Torvalds 已提交
2311

2312 2313
	if (cmd->err_info->CommandStatus != 0) {	/* an error has occurred */
		switch (cmd->err_info->CommandStatus) {
L
Linus Torvalds 已提交
2314
			unsigned char sense_key;
2315 2316 2317 2318 2319 2320 2321 2322 2323 2324 2325 2326 2327 2328
		case CMD_TARGET_STATUS:
			status = 0;

			if (cmd->err_info->ScsiStatus == 0x02) {
				printk(KERN_WARNING "cciss: cmd %p "
				       "has CHECK CONDITION "
				       " byte 2 = 0x%x\n", cmd,
				       cmd->err_info->SenseInfo[2]
				    );
				/* check the sense key */
				sense_key = 0xf & cmd->err_info->SenseInfo[2];
				/* no status or recovered error */
				if ((sense_key == 0x0) || (sense_key == 0x1)) {
					status = 1;
L
Linus Torvalds 已提交
2329
				}
2330 2331 2332 2333 2334
			} else {
				printk(KERN_WARNING "cciss: cmd %p "
				       "has SCSI Status 0x%x\n",
				       cmd, cmd->err_info->ScsiStatus);
			}
L
Linus Torvalds 已提交
2335
			break;
2336 2337 2338 2339
		case CMD_DATA_UNDERRUN:
			printk(KERN_WARNING "cciss: cmd %p has"
			       " completed with data underrun "
			       "reported\n", cmd);
L
Linus Torvalds 已提交
2340
			break;
2341 2342 2343 2344
		case CMD_DATA_OVERRUN:
			printk(KERN_WARNING "cciss: cmd %p has"
			       " completed with data overrun "
			       "reported\n", cmd);
L
Linus Torvalds 已提交
2345
			break;
2346 2347 2348 2349
		case CMD_INVALID:
			printk(KERN_WARNING "cciss: cmd %p is "
			       "reported invalid\n", cmd);
			status = 0;
L
Linus Torvalds 已提交
2350
			break;
2351 2352 2353 2354
		case CMD_PROTOCOL_ERR:
			printk(KERN_WARNING "cciss: cmd %p has "
			       "protocol error \n", cmd);
			status = 0;
L
Linus Torvalds 已提交
2355
			break;
2356 2357 2358 2359
		case CMD_HARDWARE_ERR:
			printk(KERN_WARNING "cciss: cmd %p had "
			       " hardware error\n", cmd);
			status = 0;
L
Linus Torvalds 已提交
2360
			break;
2361 2362 2363 2364
		case CMD_CONNECTION_LOST:
			printk(KERN_WARNING "cciss: cmd %p had "
			       "connection lost\n", cmd);
			status = 0;
L
Linus Torvalds 已提交
2365
			break;
2366 2367 2368 2369
		case CMD_ABORTED:
			printk(KERN_WARNING "cciss: cmd %p was "
			       "aborted\n", cmd);
			status = 0;
L
Linus Torvalds 已提交
2370
			break;
2371 2372 2373 2374
		case CMD_ABORT_FAILED:
			printk(KERN_WARNING "cciss: cmd %p reports "
			       "abort failed\n", cmd);
			status = 0;
L
Linus Torvalds 已提交
2375
			break;
2376 2377 2378 2379 2380 2381 2382 2383 2384 2385 2386 2387 2388 2389 2390 2391 2392 2393 2394 2395 2396 2397 2398
		case CMD_UNSOLICITED_ABORT:
			printk(KERN_WARNING "cciss%d: unsolicited "
			       "abort %p\n", h->ctlr, cmd);
			if (cmd->retry_count < MAX_CMD_RETRIES) {
				retry_cmd = 1;
				printk(KERN_WARNING
				       "cciss%d: retrying %p\n", h->ctlr, cmd);
				cmd->retry_count++;
			} else
				printk(KERN_WARNING
				       "cciss%d: %p retried too "
				       "many times\n", h->ctlr, cmd);
			status = 0;
			break;
		case CMD_TIMEOUT:
			printk(KERN_WARNING "cciss: cmd %p timedout\n", cmd);
			status = 0;
			break;
		default:
			printk(KERN_WARNING "cciss: cmd %p returned "
			       "unknown status %x\n", cmd,
			       cmd->err_info->CommandStatus);
			status = 0;
L
Linus Torvalds 已提交
2399 2400 2401
		}
	}
	/* We need to return this command */
2402 2403
	if (retry_cmd) {
		resend_cciss_cmd(h, cmd);
L
Linus Torvalds 已提交
2404
		return;
2405
	}
L
Linus Torvalds 已提交
2406

2407 2408
	cmd->rq->completion_data = cmd;
	cmd->rq->errors = status;
2409
	blk_add_trace_rq(cmd->rq->q, cmd->rq, BLK_TA_COMPLETE);
2410
	blk_complete_request(cmd->rq);
L
Linus Torvalds 已提交
2411 2412
}

2413 2414
/*
 * Get a request and submit it to the controller.
L
Linus Torvalds 已提交
2415 2416 2417
 */
static void do_cciss_request(request_queue_t *q)
{
2418
	ctlr_info_t *h = q->queuedata;
L
Linus Torvalds 已提交
2419 2420 2421 2422 2423 2424 2425 2426 2427 2428
	CommandList_struct *c;
	int start_blk, seg;
	struct request *creq;
	u64bit temp64;
	struct scatterlist tmp_sg[MAXSGENTRIES];
	drive_info_struct *drv;
	int i, dir;

	/* We call start_io here in case there is a command waiting on the
	 * queue that has not been sent.
2429
	 */
L
Linus Torvalds 已提交
2430 2431 2432
	if (blk_queue_plugged(q))
		goto startio;

2433
      queue:
L
Linus Torvalds 已提交
2434 2435 2436 2437
	creq = elv_next_request(q);
	if (!creq)
		goto startio;

2438
	BUG_ON(creq->nr_phys_segments > MAXSGENTRIES);
L
Linus Torvalds 已提交
2439

2440
	if ((c = cmd_alloc(h, 1)) == NULL)
L
Linus Torvalds 已提交
2441 2442 2443 2444 2445 2446 2447 2448
		goto full;

	blkdev_dequeue_request(creq);

	spin_unlock_irq(q->queue_lock);

	c->cmd_type = CMD_RWREQ;
	c->rq = creq;
2449 2450

	/* fill in the request */
L
Linus Torvalds 已提交
2451
	drv = creq->rq_disk->private_data;
2452
	c->Header.ReplyQueue = 0;	// unused in simple mode
2453 2454 2455 2456
	/* got command from pool, so use the command block index instead */
	/* for direct lookups. */
	/* The first 2 bits are reserved for controller error reporting. */
	c->Header.Tag.lower = (c->cmdindex << 3);
2457 2458
	c->Header.Tag.lower |= 0x04;	/* flag for direct lookup. */
	c->Header.LUN.LogDev.VolId = drv->LunID;
L
Linus Torvalds 已提交
2459
	c->Header.LUN.LogDev.Mode = 1;
2460 2461 2462 2463 2464 2465 2466 2467
	c->Request.CDBLen = 10;	// 12 byte commands not in FW yet;
	c->Request.Type.Type = TYPE_CMD;	// It is a command.
	c->Request.Type.Attribute = ATTR_SIMPLE;
	c->Request.Type.Direction =
	    (rq_data_dir(creq) == READ) ? XFER_READ : XFER_WRITE;
	c->Request.Timeout = 0;	// Don't time out
	c->Request.CDB[0] =
	    (rq_data_dir(creq) == READ) ? CCISS_READ : CCISS_WRITE;
L
Linus Torvalds 已提交
2468 2469
	start_blk = creq->sector;
#ifdef CCISS_DEBUG
2470 2471 2472
	printk(KERN_DEBUG "ciss: sector =%d nr_sectors=%d\n", (int)creq->sector,
	       (int)creq->nr_sectors);
#endif				/* CCISS_DEBUG */
L
Linus Torvalds 已提交
2473 2474 2475

	seg = blk_rq_map_sg(q, creq, tmp_sg);

2476
	/* get the DMA records for the setup */
L
Linus Torvalds 已提交
2477 2478 2479 2480 2481
	if (c->Request.Type.Direction == XFER_READ)
		dir = PCI_DMA_FROMDEVICE;
	else
		dir = PCI_DMA_TODEVICE;

2482
	for (i = 0; i < seg; i++) {
L
Linus Torvalds 已提交
2483 2484
		c->SG[i].Len = tmp_sg[i].length;
		temp64.val = (__u64) pci_map_page(h->pdev, tmp_sg[i].page,
2485 2486
						  tmp_sg[i].offset,
						  tmp_sg[i].length, dir);
L
Linus Torvalds 已提交
2487
		c->SG[i].Addr.lower = temp64.val32.lower;
2488 2489
		c->SG[i].Addr.upper = temp64.val32.upper;
		c->SG[i].Ext = 0;	// we are not chaining
L
Linus Torvalds 已提交
2490
	}
2491 2492 2493
	/* track how many SG entries we are using */
	if (seg > h->maxSG)
		h->maxSG = seg;
L
Linus Torvalds 已提交
2494 2495

#ifdef CCISS_DEBUG
2496 2497 2498
	printk(KERN_DEBUG "cciss: Submitting %d sectors in %d segments\n",
	       creq->nr_sectors, seg);
#endif				/* CCISS_DEBUG */
L
Linus Torvalds 已提交
2499 2500

	c->Header.SGList = c->Header.SGTotal = seg;
2501 2502 2503 2504 2505 2506 2507 2508
	c->Request.CDB[1] = 0;
	c->Request.CDB[2] = (start_blk >> 24) & 0xff;	//MSB
	c->Request.CDB[3] = (start_blk >> 16) & 0xff;
	c->Request.CDB[4] = (start_blk >> 8) & 0xff;
	c->Request.CDB[5] = start_blk & 0xff;
	c->Request.CDB[6] = 0;	// (sect >> 24) & 0xff; MSB
	c->Request.CDB[7] = (creq->nr_sectors >> 8) & 0xff;
	c->Request.CDB[8] = creq->nr_sectors & 0xff;
L
Linus Torvalds 已提交
2509 2510 2511 2512
	c->Request.CDB[9] = c->Request.CDB[11] = c->Request.CDB[12] = 0;

	spin_lock_irq(q->queue_lock);

2513
	addQ(&(h->reqQ), c);
L
Linus Torvalds 已提交
2514
	h->Qdepth++;
2515 2516
	if (h->Qdepth > h->maxQsinceinit)
		h->maxQsinceinit = h->Qdepth;
L
Linus Torvalds 已提交
2517 2518

	goto queue;
2519
      full:
L
Linus Torvalds 已提交
2520
	blk_stop_queue(q);
2521
      startio:
L
Linus Torvalds 已提交
2522 2523
	/* We will already have the driver lock here so not need
	 * to lock it.
2524
	 */
L
Linus Torvalds 已提交
2525 2526 2527
	start_io(h);
}

2528 2529 2530 2531 2532 2533 2534 2535 2536 2537 2538 2539 2540 2541 2542 2543 2544 2545 2546 2547 2548 2549 2550
static inline unsigned long get_next_completion(ctlr_info_t *h)
{
#ifdef CONFIG_CISS_SCSI_TAPE
	/* Any rejects from sendcmd() lying around? Process them first */
	if (h->scsi_rejects.ncompletions == 0)
		return h->access.command_completed(h);
	else {
		struct sendcmd_reject_list *srl;
		int n;
		srl = &h->scsi_rejects;
		n = --srl->ncompletions;
		/* printk("cciss%d: processing saved reject\n", h->ctlr); */
		printk("p");
		return srl->complete[n];
	}
#else
	return h->access.command_completed(h);
#endif
}

static inline int interrupt_pending(ctlr_info_t *h)
{
#ifdef CONFIG_CISS_SCSI_TAPE
2551
	return (h->access.intr_pending(h)
2552 2553 2554 2555 2556 2557 2558 2559 2560
		|| (h->scsi_rejects.ncompletions > 0));
#else
	return h->access.intr_pending(h);
#endif
}

static inline long interrupt_not_for_us(ctlr_info_t *h)
{
#ifdef CONFIG_CISS_SCSI_TAPE
2561 2562 2563
	return (((h->access.intr_pending(h) == 0) ||
		 (h->interrupts_enabled == 0))
		&& (h->scsi_rejects.ncompletions == 0));
2564
#else
2565
	return (((h->access.intr_pending(h) == 0) ||
2566 2567 2568 2569
		 (h->interrupts_enabled == 0)));
#endif
}

L
Linus Torvalds 已提交
2570 2571 2572 2573 2574
static irqreturn_t do_cciss_intr(int irq, void *dev_id, struct pt_regs *regs)
{
	ctlr_info_t *h = dev_id;
	CommandList_struct *c;
	unsigned long flags;
2575
	__u32 a, a1, a2;
L
Linus Torvalds 已提交
2576

2577
	if (interrupt_not_for_us(h))
L
Linus Torvalds 已提交
2578 2579 2580 2581 2582 2583
		return IRQ_NONE;
	/*
	 * If there are completed commands in the completion queue,
	 * we had better do something about it.
	 */
	spin_lock_irqsave(CCISS_LOCK(h->ctlr), flags);
2584
	while (interrupt_pending(h)) {
2585
		while ((a = get_next_completion(h)) != FIFO_EMPTY) {
L
Linus Torvalds 已提交
2586
			a1 = a;
2587 2588 2589
			if ((a & 0x04)) {
				a2 = (a >> 3);
				if (a2 >= NR_CMDS) {
2590 2591 2592
					printk(KERN_WARNING
					       "cciss: controller cciss%d failed, stopping.\n",
					       h->ctlr);
2593 2594 2595 2596 2597 2598 2599 2600
					fail_all_cmds(h->ctlr);
					return IRQ_HANDLED;
				}

				c = h->cmd_pool + a2;
				a = c->busaddr;

			} else {
2601
				a &= ~3;
2602
				if ((c = h->cmpQ) == NULL) {
2603 2604 2605 2606 2607 2608 2609 2610 2611 2612
					printk(KERN_WARNING
					       "cciss: Completion of %08x ignored\n",
					       a1);
					continue;
				}
				while (c->busaddr != a) {
					c = c->next;
					if (c == h->cmpQ)
						break;
				}
2613
			}
L
Linus Torvalds 已提交
2614 2615 2616 2617
			/*
			 * If we've found the command, take it off the
			 * completion Q and free it
			 */
2618
			if (c->busaddr == a) {
L
Linus Torvalds 已提交
2619 2620 2621 2622 2623 2624 2625 2626 2627 2628 2629 2630 2631 2632 2633 2634 2635 2636
				removeQ(&h->cmpQ, c);
				if (c->cmd_type == CMD_RWREQ) {
					complete_command(h, c, 0);
				} else if (c->cmd_type == CMD_IOCTL_PEND) {
					complete(c->waiting);
				}
#				ifdef CONFIG_CISS_SCSI_TAPE
				else if (c->cmd_type == CMD_SCSI)
					complete_scsi_command(c, 0, a1);
#				endif
				continue;
			}
		}
	}

	spin_unlock_irqrestore(CCISS_LOCK(h->ctlr), flags);
	return IRQ_HANDLED;
}
2637 2638

/*
2639
 *  We cannot read the structure directly, for portability we must use
L
Linus Torvalds 已提交
2640
 *   the io functions.
2641
 *   This is for debug only.
L
Linus Torvalds 已提交
2642 2643
 */
#ifdef CCISS_DEBUG
2644
static void print_cfg_table(CfgTable_struct *tb)
L
Linus Torvalds 已提交
2645 2646 2647 2648 2649 2650
{
	int i;
	char temp_name[17];

	printk("Controller Configuration information\n");
	printk("------------------------------------\n");
2651
	for (i = 0; i < 4; i++)
L
Linus Torvalds 已提交
2652
		temp_name[i] = readb(&(tb->Signature[i]));
2653 2654
	temp_name[4] = '\0';
	printk("   Signature = %s\n", temp_name);
L
Linus Torvalds 已提交
2655
	printk("   Spec Number = %d\n", readl(&(tb->SpecValence)));
2656 2657 2658 2659 2660 2661
	printk("   Transport methods supported = 0x%x\n",
	       readl(&(tb->TransportSupport)));
	printk("   Transport methods active = 0x%x\n",
	       readl(&(tb->TransportActive)));
	printk("   Requested transport Method = 0x%x\n",
	       readl(&(tb->HostWrite.TransportRequest)));
2662
	printk("   Coalesce Interrupt Delay = 0x%x\n",
2663
	       readl(&(tb->HostWrite.CoalIntDelay)));
2664
	printk("   Coalesce Interrupt Count = 0x%x\n",
2665 2666 2667 2668 2669
	       readl(&(tb->HostWrite.CoalIntCount)));
	printk("   Max outstanding commands = 0x%d\n",
	       readl(&(tb->CmdsOutMax)));
	printk("   Bus Types = 0x%x\n", readl(&(tb->BusTypes)));
	for (i = 0; i < 16; i++)
L
Linus Torvalds 已提交
2670 2671 2672
		temp_name[i] = readb(&(tb->ServerName[i]));
	temp_name[16] = '\0';
	printk("   Server Name = %s\n", temp_name);
2673
	printk("   Heartbeat Counter = 0x%x\n\n\n", readl(&(tb->HeartBeat)));
L
Linus Torvalds 已提交
2674
}
2675
#endif				/* CCISS_DEBUG */
L
Linus Torvalds 已提交
2676

2677
static int find_PCI_BAR_index(struct pci_dev *pdev, unsigned long pci_bar_addr)
L
Linus Torvalds 已提交
2678 2679
{
	int i, offset, mem_type, bar_type;
2680
	if (pci_bar_addr == PCI_BASE_ADDRESS_0)	/* looking for BAR zero? */
L
Linus Torvalds 已提交
2681 2682
		return 0;
	offset = 0;
2683 2684
	for (i = 0; i < DEVICE_COUNT_RESOURCE; i++) {
		bar_type = pci_resource_flags(pdev, i) & PCI_BASE_ADDRESS_SPACE;
L
Linus Torvalds 已提交
2685 2686 2687 2688
		if (bar_type == PCI_BASE_ADDRESS_SPACE_IO)
			offset += 4;
		else {
			mem_type = pci_resource_flags(pdev, i) &
2689
			    PCI_BASE_ADDRESS_MEM_TYPE_MASK;
L
Linus Torvalds 已提交
2690
			switch (mem_type) {
2691 2692 2693 2694 2695 2696 2697 2698 2699 2700 2701
			case PCI_BASE_ADDRESS_MEM_TYPE_32:
			case PCI_BASE_ADDRESS_MEM_TYPE_1M:
				offset += 4;	/* 32 bit */
				break;
			case PCI_BASE_ADDRESS_MEM_TYPE_64:
				offset += 8;
				break;
			default:	/* reserved in PCI 2.2 */
				printk(KERN_WARNING
				       "Base address is invalid\n");
				return -1;
L
Linus Torvalds 已提交
2702 2703 2704
				break;
			}
		}
2705 2706
		if (offset == pci_bar_addr - PCI_BASE_ADDRESS_0)
			return i + 1;
L
Linus Torvalds 已提交
2707 2708 2709 2710
	}
	return -1;
}

2711 2712 2713 2714
/* If MSI/MSI-X is supported by the kernel we will try to enable it on
 * controllers that are capable. If not, we use IO-APIC mode.
 */

2715 2716
static void __devinit cciss_interrupt_mode(ctlr_info_t *c,
					   struct pci_dev *pdev, __u32 board_id)
2717 2718
{
#ifdef CONFIG_PCI_MSI
2719 2720 2721 2722
	int err;
	struct msix_entry cciss_msix_entries[4] = { {0, 0}, {0, 1},
	{0, 2}, {0, 3}
	};
2723 2724 2725

	/* Some boards advertise MSI but don't really support it */
	if ((board_id == 0x40700E11) ||
2726 2727
	    (board_id == 0x40800E11) ||
	    (board_id == 0x40820E11) || (board_id == 0x40830E11))
2728 2729
		goto default_int_mode;

2730 2731 2732 2733 2734 2735 2736 2737 2738 2739 2740 2741 2742 2743 2744 2745 2746 2747 2748 2749 2750 2751 2752 2753 2754 2755 2756 2757 2758 2759 2760
	if (pci_find_capability(pdev, PCI_CAP_ID_MSIX)) {
		err = pci_enable_msix(pdev, cciss_msix_entries, 4);
		if (!err) {
			c->intr[0] = cciss_msix_entries[0].vector;
			c->intr[1] = cciss_msix_entries[1].vector;
			c->intr[2] = cciss_msix_entries[2].vector;
			c->intr[3] = cciss_msix_entries[3].vector;
			c->msix_vector = 1;
			return;
		}
		if (err > 0) {
			printk(KERN_WARNING "cciss: only %d MSI-X vectors "
			       "available\n", err);
		} else {
			printk(KERN_WARNING "cciss: MSI-X init failed %d\n",
			       err);
		}
	}
	if (pci_find_capability(pdev, PCI_CAP_ID_MSI)) {
		if (!pci_enable_msi(pdev)) {
			c->intr[SIMPLE_MODE_INT] = pdev->irq;
			c->msi_vector = 1;
			return;
		} else {
			printk(KERN_WARNING "cciss: MSI init failed\n");
			c->intr[SIMPLE_MODE_INT] = pdev->irq;
			return;
		}
	}
      default_int_mode:
#endif				/* CONFIG_PCI_MSI */
2761
	/* if we get here we're going to use the default interrupt mode */
2762
	c->intr[SIMPLE_MODE_INT] = pdev->irq;
2763 2764 2765
	return;
}

L
Linus Torvalds 已提交
2766 2767 2768 2769 2770 2771 2772
static int cciss_pci_init(ctlr_info_t *c, struct pci_dev *pdev)
{
	ushort subsystem_vendor_id, subsystem_device_id, command;
	__u32 board_id, scratchpad = 0;
	__u64 cfg_offset;
	__u32 cfg_base_addr;
	__u64 cfg_base_addr_index;
2773
	int i, err;
L
Linus Torvalds 已提交
2774 2775 2776

	/* check to see if controller has been disabled */
	/* BEFORE trying to enable it */
2777 2778 2779 2780
	(void)pci_read_config_word(pdev, PCI_COMMAND, &command);
	if (!(command & 0x02)) {
		printk(KERN_WARNING
		       "cciss: controller appears to be disabled\n");
2781
		return -ENODEV;
L
Linus Torvalds 已提交
2782 2783
	}

2784
	err = pci_enable_device(pdev);
2785
	if (err) {
L
Linus Torvalds 已提交
2786
		printk(KERN_ERR "cciss: Unable to Enable PCI device\n");
2787
		return err;
L
Linus Torvalds 已提交
2788 2789
	}

2790 2791 2792
	err = pci_request_regions(pdev, "cciss");
	if (err) {
		printk(KERN_ERR "cciss: Cannot obtain PCI resources, "
2793
		       "aborting\n");
2794 2795 2796
		goto err_out_disable_pdev;
	}

L
Linus Torvalds 已提交
2797 2798 2799
	subsystem_vendor_id = pdev->subsystem_vendor;
	subsystem_device_id = pdev->subsystem_device;
	board_id = (((__u32) (subsystem_device_id << 16) & 0xffff0000) |
2800
		    subsystem_vendor_id);
L
Linus Torvalds 已提交
2801 2802 2803 2804 2805

#ifdef CCISS_DEBUG
	printk("command = %x\n", command);
	printk("irq = %x\n", pdev->irq);
	printk("board_id = %x\n", board_id);
2806
#endif				/* CCISS_DEBUG */
L
Linus Torvalds 已提交
2807

2808 2809 2810 2811
/* If the kernel supports MSI/MSI-X we will try to enable that functionality,
 * else we use the IO-APIC interrupt assigned to us by system ROM.
 */
	cciss_interrupt_mode(c, pdev, board_id);
L
Linus Torvalds 已提交
2812 2813 2814

	/*
	 * Memory base addr is first addr , the second points to the config
2815
	 *   table
L
Linus Torvalds 已提交
2816 2817
	 */

2818
	c->paddr = pci_resource_start(pdev, 0);	/* addressing mode bits already removed */
L
Linus Torvalds 已提交
2819 2820
#ifdef CCISS_DEBUG
	printk("address 0 = %x\n", c->paddr);
2821
#endif				/* CCISS_DEBUG */
L
Linus Torvalds 已提交
2822 2823 2824 2825
	c->vaddr = remap_pci_mem(c->paddr, 200);

	/* Wait for the board to become ready.  (PCI hotplug needs this.)
	 * We poll for up to 120 secs, once per 100ms. */
2826
	for (i = 0; i < 1200; i++) {
L
Linus Torvalds 已提交
2827 2828 2829 2830
		scratchpad = readl(c->vaddr + SA5_SCRATCHPAD_OFFSET);
		if (scratchpad == CCISS_FIRMWARE_READY)
			break;
		set_current_state(TASK_INTERRUPTIBLE);
2831
		schedule_timeout(HZ / 10);	/* wait 100ms */
L
Linus Torvalds 已提交
2832 2833 2834
	}
	if (scratchpad != CCISS_FIRMWARE_READY) {
		printk(KERN_WARNING "cciss: Board not ready.  Timed out.\n");
2835
		err = -ENODEV;
2836
		goto err_out_free_res;
L
Linus Torvalds 已提交
2837 2838 2839 2840 2841 2842 2843
	}

	/* get the address index number */
	cfg_base_addr = readl(c->vaddr + SA5_CTCFG_OFFSET);
	cfg_base_addr &= (__u32) 0x0000ffff;
#ifdef CCISS_DEBUG
	printk("cfg base address = %x\n", cfg_base_addr);
2844 2845
#endif				/* CCISS_DEBUG */
	cfg_base_addr_index = find_PCI_BAR_index(pdev, cfg_base_addr);
L
Linus Torvalds 已提交
2846 2847
#ifdef CCISS_DEBUG
	printk("cfg base address index = %x\n", cfg_base_addr_index);
2848
#endif				/* CCISS_DEBUG */
L
Linus Torvalds 已提交
2849 2850
	if (cfg_base_addr_index == -1) {
		printk(KERN_WARNING "cciss: Cannot find cfg_base_addr_index\n");
2851
		err = -ENODEV;
2852
		goto err_out_free_res;
L
Linus Torvalds 已提交
2853 2854 2855 2856 2857
	}

	cfg_offset = readl(c->vaddr + SA5_CTMEM_OFFSET);
#ifdef CCISS_DEBUG
	printk("cfg offset = %x\n", cfg_offset);
2858 2859 2860 2861
#endif				/* CCISS_DEBUG */
	c->cfgtable = remap_pci_mem(pci_resource_start(pdev,
						       cfg_base_addr_index) +
				    cfg_offset, sizeof(CfgTable_struct));
L
Linus Torvalds 已提交
2862 2863 2864
	c->board_id = board_id;

#ifdef CCISS_DEBUG
2865
	print_cfg_table(c->cfgtable);
2866
#endif				/* CCISS_DEBUG */
L
Linus Torvalds 已提交
2867

2868
	for (i = 0; i < ARRAY_SIZE(products); i++) {
L
Linus Torvalds 已提交
2869 2870 2871 2872 2873 2874
		if (board_id == products[i].board_id) {
			c->product_name = products[i].product_name;
			c->access = *(products[i].access);
			break;
		}
	}
2875
	if (i == ARRAY_SIZE(products)) {
L
Linus Torvalds 已提交
2876
		printk(KERN_WARNING "cciss: Sorry, I don't know how"
2877 2878
		       " to access the Smart Array controller %08lx\n",
		       (unsigned long)board_id);
2879
		err = -ENODEV;
2880
		goto err_out_free_res;
L
Linus Torvalds 已提交
2881
	}
2882 2883 2884 2885
	if ((readb(&c->cfgtable->Signature[0]) != 'C') ||
	    (readb(&c->cfgtable->Signature[1]) != 'I') ||
	    (readb(&c->cfgtable->Signature[2]) != 'S') ||
	    (readb(&c->cfgtable->Signature[3]) != 'S')) {
L
Linus Torvalds 已提交
2886
		printk("Does not appear to be a valid CISS config table\n");
2887
		err = -ENODEV;
2888
		goto err_out_free_res;
L
Linus Torvalds 已提交
2889 2890
	}
#ifdef CONFIG_X86
2891 2892 2893 2894 2895 2896 2897
	{
		/* Need to enable prefetch in the SCSI core for 6400 in x86 */
		__u32 prefetch;
		prefetch = readl(&(c->cfgtable->SCSI_Prefetch));
		prefetch |= 0x100;
		writel(prefetch, &(c->cfgtable->SCSI_Prefetch));
	}
L
Linus Torvalds 已提交
2898 2899 2900 2901
#endif

#ifdef CCISS_DEBUG
	printk("Trying to put board into Simple mode\n");
2902
#endif				/* CCISS_DEBUG */
L
Linus Torvalds 已提交
2903
	c->max_commands = readl(&(c->cfgtable->CmdsOutMax));
2904 2905 2906
	/* Update the field, and then ring the doorbell */
	writel(CFGTBL_Trans_Simple, &(c->cfgtable->HostWrite.TransportRequest));
	writel(CFGTBL_ChangeReq, c->vaddr + SA5_DOORBELL);
L
Linus Torvalds 已提交
2907 2908 2909 2910

	/* under certain very rare conditions, this can take awhile.
	 * (e.g.: hot replace a failed 144GB drive in a RAID 5 set right
	 * as we enter this code.) */
2911
	for (i = 0; i < MAX_CONFIG_WAIT; i++) {
L
Linus Torvalds 已提交
2912 2913 2914 2915 2916
		if (!(readl(c->vaddr + SA5_DOORBELL) & CFGTBL_ChangeReq))
			break;
		/* delay and try again */
		set_current_state(TASK_INTERRUPTIBLE);
		schedule_timeout(10);
2917
	}
L
Linus Torvalds 已提交
2918 2919

#ifdef CCISS_DEBUG
2920 2921 2922
	printk(KERN_DEBUG "I counter got to %d %x\n", i,
	       readl(c->vaddr + SA5_DOORBELL));
#endif				/* CCISS_DEBUG */
L
Linus Torvalds 已提交
2923
#ifdef CCISS_DEBUG
2924 2925
	print_cfg_table(c->cfgtable);
#endif				/* CCISS_DEBUG */
L
Linus Torvalds 已提交
2926

2927
	if (!(readl(&(c->cfgtable->TransportActive)) & CFGTBL_Trans_Simple)) {
L
Linus Torvalds 已提交
2928
		printk(KERN_WARNING "cciss: unable to get board into"
2929
		       " simple mode\n");
2930
		err = -ENODEV;
2931
		goto err_out_free_res;
L
Linus Torvalds 已提交
2932 2933 2934
	}
	return 0;

2935
      err_out_free_res:
2936 2937
	pci_release_regions(pdev);

2938
      err_out_disable_pdev:
2939 2940
	pci_disable_device(pdev);
	return err;
L
Linus Torvalds 已提交
2941 2942
}

2943 2944 2945
/*
 * Gets information about the local volumes attached to the controller.
 */
L
Linus Torvalds 已提交
2946 2947 2948 2949 2950 2951 2952 2953 2954 2955
static void cciss_getgeometry(int cntl_num)
{
	ReportLunData_struct *ld_buff;
	ReadCapdata_struct *size_buff;
	InquiryData_struct *inq_buff;
	int return_code;
	int i;
	int listlength = 0;
	__u32 lunid = 0;
	int block_size;
2956
	int total_size;
L
Linus Torvalds 已提交
2957

2958
	ld_buff = kzalloc(sizeof(ReportLunData_struct), GFP_KERNEL);
2959 2960 2961 2962 2963 2964
	if (ld_buff == NULL) {
		printk(KERN_ERR "cciss: out of memory\n");
		return;
	}
	size_buff = kmalloc(sizeof(ReadCapdata_struct), GFP_KERNEL);
	if (size_buff == NULL) {
L
Linus Torvalds 已提交
2965
		printk(KERN_ERR "cciss: out of memory\n");
2966
		kfree(ld_buff);
L
Linus Torvalds 已提交
2967 2968
		return;
	}
2969 2970 2971
	inq_buff = kmalloc(sizeof(InquiryData_struct), GFP_KERNEL);
	if (inq_buff == NULL) {
		printk(KERN_ERR "cciss: out of memory\n");
L
Linus Torvalds 已提交
2972 2973
		kfree(ld_buff);
		kfree(size_buff);
2974 2975 2976 2977 2978 2979 2980
		return;
	}
	/* Get the firmware version */
	return_code = sendcmd(CISS_INQUIRY, cntl_num, inq_buff,
			      sizeof(InquiryData_struct), 0, 0, 0, NULL,
			      TYPE_CMD);
	if (return_code == IO_OK) {
L
Linus Torvalds 已提交
2981 2982 2983 2984
		hba[cntl_num]->firm_ver[0] = inq_buff->data_byte[32];
		hba[cntl_num]->firm_ver[1] = inq_buff->data_byte[33];
		hba[cntl_num]->firm_ver[2] = inq_buff->data_byte[34];
		hba[cntl_num]->firm_ver[3] = inq_buff->data_byte[35];
2985 2986
	} else {		/* send command failed */

L
Linus Torvalds 已提交
2987
		printk(KERN_WARNING "cciss: unable to determine firmware"
2988
		       " version of controller\n");
L
Linus Torvalds 已提交
2989
	}
2990 2991 2992 2993
	/* Get the number of logical volumes */
	return_code = sendcmd(CISS_REPORT_LOG, cntl_num, ld_buff,
			      sizeof(ReportLunData_struct), 0, 0, 0, NULL,
			      TYPE_CMD);
L
Linus Torvalds 已提交
2994

2995
	if (return_code == IO_OK) {
L
Linus Torvalds 已提交
2996 2997
#ifdef CCISS_DEBUG
		printk("LUN Data\n--------------------------\n");
2998 2999 3000 3001 3002 3003 3004 3005
#endif				/* CCISS_DEBUG */

		listlength |=
		    (0xff & (unsigned int)(ld_buff->LUNListLength[0])) << 24;
		listlength |=
		    (0xff & (unsigned int)(ld_buff->LUNListLength[1])) << 16;
		listlength |=
		    (0xff & (unsigned int)(ld_buff->LUNListLength[2])) << 8;
L
Linus Torvalds 已提交
3006
		listlength |= 0xff & (unsigned int)(ld_buff->LUNListLength[3]);
3007 3008
	} else {		/* reading number of logical volumes failed */

L
Linus Torvalds 已提交
3009
		printk(KERN_WARNING "cciss: report logical volume"
3010
		       " command failed\n");
L
Linus Torvalds 已提交
3011 3012
		listlength = 0;
	}
3013 3014 3015 3016 3017
	hba[cntl_num]->num_luns = listlength / 8;	// 8 bytes pre entry
	if (hba[cntl_num]->num_luns > CISS_MAX_LUN) {
		printk(KERN_ERR
		       "ciss:  only %d number of logical volumes supported\n",
		       CISS_MAX_LUN);
L
Linus Torvalds 已提交
3018 3019 3020
		hba[cntl_num]->num_luns = CISS_MAX_LUN;
	}
#ifdef CCISS_DEBUG
3021 3022 3023 3024 3025 3026 3027 3028 3029 3030 3031 3032 3033 3034 3035 3036 3037 3038 3039
	printk(KERN_DEBUG "Length = %x %x %x %x = %d\n",
	       ld_buff->LUNListLength[0], ld_buff->LUNListLength[1],
	       ld_buff->LUNListLength[2], ld_buff->LUNListLength[3],
	       hba[cntl_num]->num_luns);
#endif				/* CCISS_DEBUG */

	hba[cntl_num]->highest_lun = hba[cntl_num]->num_luns - 1;
//      for(i=0; i<  hba[cntl_num]->num_luns; i++)
	for (i = 0; i < CISS_MAX_LUN; i++) {
		if (i < hba[cntl_num]->num_luns) {
			lunid = (0xff & (unsigned int)(ld_buff->LUN[i][3]))
			    << 24;
			lunid |= (0xff & (unsigned int)(ld_buff->LUN[i][2]))
			    << 16;
			lunid |= (0xff & (unsigned int)(ld_buff->LUN[i][1]))
			    << 8;
			lunid |= 0xff & (unsigned int)(ld_buff->LUN[i][0]);

			hba[cntl_num]->drv[i].LunID = lunid;
L
Linus Torvalds 已提交
3040 3041

#ifdef CCISS_DEBUG
3042 3043 3044 3045 3046 3047 3048
			printk(KERN_DEBUG "LUN[%d]:  %x %x %x %x = %x\n", i,
			       ld_buff->LUN[i][0], ld_buff->LUN[i][1],
			       ld_buff->LUN[i][2], ld_buff->LUN[i][3],
			       hba[cntl_num]->drv[i].LunID);
#endif				/* CCISS_DEBUG */
			cciss_read_capacity(cntl_num, i, size_buff, 0,
					    &total_size, &block_size);
3049
			cciss_geometry_inquiry(cntl_num, i, 0, total_size,
3050 3051
					       block_size, inq_buff,
					       &hba[cntl_num]->drv[i]);
3052 3053 3054 3055
		} else {
			/* initialize raid_level to indicate a free space */
			hba[cntl_num]->drv[i].raid_level = -1;
		}
L
Linus Torvalds 已提交
3056 3057 3058 3059
	}
	kfree(ld_buff);
	kfree(size_buff);
	kfree(inq_buff);
3060
}
L
Linus Torvalds 已提交
3061 3062 3063 3064 3065 3066 3067 3068 3069 3070 3071 3072 3073

/* Function to find the first free pointer into our hba[] array */
/* Returns -1 if no free entries are left.  */
static int alloc_cciss_hba(void)
{
	struct gendisk *disk[NWD];
	int i, n;
	for (n = 0; n < NWD; n++) {
		disk[n] = alloc_disk(1 << NWD_SHIFT);
		if (!disk[n])
			goto out;
	}

3074
	for (i = 0; i < MAX_CTLR; i++) {
L
Linus Torvalds 已提交
3075 3076
		if (!hba[i]) {
			ctlr_info_t *p;
3077
			p = kzalloc(sizeof(ctlr_info_t), GFP_KERNEL);
L
Linus Torvalds 已提交
3078 3079 3080 3081 3082 3083 3084 3085 3086
			if (!p)
				goto Enomem;
			for (n = 0; n < NWD; n++)
				p->gendisk[n] = disk[n];
			hba[i] = p;
			return i;
		}
	}
	printk(KERN_WARNING "cciss: This driver supports a maximum"
3087
	       " of %d controllers.\n", MAX_CTLR);
L
Linus Torvalds 已提交
3088
	goto out;
3089
      Enomem:
L
Linus Torvalds 已提交
3090
	printk(KERN_ERR "cciss: out of memory.\n");
3091
      out:
L
Linus Torvalds 已提交
3092 3093 3094 3095 3096 3097 3098 3099 3100 3101 3102 3103 3104 3105 3106 3107 3108 3109 3110 3111 3112 3113
	while (n--)
		put_disk(disk[n]);
	return -1;
}

static void free_hba(int i)
{
	ctlr_info_t *p = hba[i];
	int n;

	hba[i] = NULL;
	for (n = 0; n < NWD; n++)
		put_disk(p->gendisk[n]);
	kfree(p);
}

/*
 *  This is it.  Find all the controllers and register them.  I really hate
 *  stealing all these major device numbers.
 *  returns the number of block devices registered.
 */
static int __devinit cciss_init_one(struct pci_dev *pdev,
3114
				    const struct pci_device_id *ent)
L
Linus Torvalds 已提交
3115 3116 3117 3118 3119
{
	request_queue_t *q;
	int i;
	int j;
	int rc;
3120
	int dac;
L
Linus Torvalds 已提交
3121 3122

	i = alloc_cciss_hba();
3123
	if (i < 0)
3124
		return -1;
3125 3126 3127

	hba[i]->busy_initializing = 1;

L
Linus Torvalds 已提交
3128 3129 3130 3131 3132 3133 3134 3135
	if (cciss_pci_init(hba[i], pdev) != 0)
		goto clean1;

	sprintf(hba[i]->devname, "cciss%d", i);
	hba[i]->ctlr = i;
	hba[i]->pdev = pdev;

	/* configure PCI DMA stuff */
3136
	if (!pci_set_dma_mask(pdev, DMA_64BIT_MASK))
3137
		dac = 1;
3138
	else if (!pci_set_dma_mask(pdev, DMA_32BIT_MASK))
3139
		dac = 0;
L
Linus Torvalds 已提交
3140
	else {
3141
		printk(KERN_ERR "cciss: no suitable DMA available\n");
L
Linus Torvalds 已提交
3142 3143 3144 3145 3146 3147 3148 3149 3150
		goto clean1;
	}

	/*
	 * register with the major number, or get a dynamic major number
	 * by passing 0 as argument.  This is done for greater than
	 * 8 controller support.
	 */
	if (i < MAX_CTLR_ORIG)
3151
		hba[i]->major = COMPAQ_CISS_MAJOR + i;
L
Linus Torvalds 已提交
3152
	rc = register_blkdev(hba[i]->major, hba[i]->devname);
3153
	if (rc == -EBUSY || rc == -EINVAL) {
L
Linus Torvalds 已提交
3154
		printk(KERN_ERR
3155 3156
		       "cciss:  Unable to get major number %d for %s "
		       "on hba %d\n", hba[i]->major, hba[i]->devname, i);
L
Linus Torvalds 已提交
3157
		goto clean1;
3158
	} else {
L
Linus Torvalds 已提交
3159 3160 3161 3162 3163 3164
		if (i >= MAX_CTLR_ORIG)
			hba[i]->major = rc;
	}

	/* make sure the board interrupts are off */
	hba[i]->access.set_intr_mask(hba[i], CCISS_INTR_OFF);
3165
	if (request_irq(hba[i]->intr[SIMPLE_MODE_INT], do_cciss_intr,
3166
			IRQF_DISABLED | IRQF_SHARED, hba[i]->devname, hba[i])) {
L
Linus Torvalds 已提交
3167
		printk(KERN_ERR "cciss: Unable to get irq %d for %s\n",
3168
		       hba[i]->intr[SIMPLE_MODE_INT], hba[i]->devname);
L
Linus Torvalds 已提交
3169 3170
		goto clean2;
	}
3171 3172

	printk(KERN_INFO "%s: <0x%x> at PCI %s IRQ %d%s using DAC\n",
3173 3174 3175 3176 3177 3178 3179 3180 3181 3182 3183 3184 3185 3186 3187 3188 3189 3190
	       hba[i]->devname, pdev->device, pci_name(pdev),
	       hba[i]->intr[SIMPLE_MODE_INT], dac ? "" : " not");

	hba[i]->cmd_pool_bits =
	    kmalloc(((NR_CMDS + BITS_PER_LONG -
		      1) / BITS_PER_LONG) * sizeof(unsigned long), GFP_KERNEL);
	hba[i]->cmd_pool = (CommandList_struct *)
	    pci_alloc_consistent(hba[i]->pdev,
		    NR_CMDS * sizeof(CommandList_struct),
		    &(hba[i]->cmd_pool_dhandle));
	hba[i]->errinfo_pool = (ErrorInfo_struct *)
	    pci_alloc_consistent(hba[i]->pdev,
		    NR_CMDS * sizeof(ErrorInfo_struct),
		    &(hba[i]->errinfo_pool_dhandle));
	if ((hba[i]->cmd_pool_bits == NULL)
	    || (hba[i]->cmd_pool == NULL)
	    || (hba[i]->errinfo_pool == NULL)) {
		printk(KERN_ERR "cciss: out of memory");
L
Linus Torvalds 已提交
3191 3192
		goto clean4;
	}
3193
#ifdef CONFIG_CISS_SCSI_TAPE
3194 3195 3196
	hba[i]->scsi_rejects.complete =
	    kmalloc(sizeof(hba[i]->scsi_rejects.complete[0]) *
		    (NR_CMDS + 5), GFP_KERNEL);
3197
	if (hba[i]->scsi_rejects.complete == NULL) {
3198
		printk(KERN_ERR "cciss: out of memory");
3199 3200 3201
		goto clean4;
	}
#endif
L
Linus Torvalds 已提交
3202 3203
	spin_lock_init(&hba[i]->lock);

3204 3205
	/* Initialize the pdev driver private data.
	   have it point to hba[i].  */
L
Linus Torvalds 已提交
3206
	pci_set_drvdata(pdev, hba[i]);
3207 3208 3209 3210 3211
	/* command and error info recs zeroed out before
	   they are used */
	memset(hba[i]->cmd_pool_bits, 0,
	       ((NR_CMDS + BITS_PER_LONG -
		 1) / BITS_PER_LONG) * sizeof(unsigned long));
L
Linus Torvalds 已提交
3212

3213 3214 3215
#ifdef CCISS_DEBUG
	printk(KERN_DEBUG "Scanning for drives on controller cciss%d\n", i);
#endif				/* CCISS_DEBUG */
L
Linus Torvalds 已提交
3216 3217 3218 3219 3220 3221 3222 3223 3224

	cciss_getgeometry(i);

	cciss_scsi_setup(i);

	/* Turn the interrupts on so we can service requests */
	hba[i]->access.set_intr_mask(hba[i], CCISS_INTR_ON);

	cciss_procinit(i);
3225
	hba[i]->busy_initializing = 0;
L
Linus Torvalds 已提交
3226

3227
	for (j = 0; j < NWD; j++) {	/* mfm */
M
Mike Miller 已提交
3228 3229 3230 3231 3232 3233
		drive_info_struct *drv = &(hba[i]->drv[j]);
		struct gendisk *disk = hba[i]->gendisk[j];

		q = blk_init_queue(do_cciss_request, &hba[i]->lock);
		if (!q) {
			printk(KERN_ERR
3234 3235
			       "cciss:  unable to allocate queue for disk %d\n",
			       j);
M
Mike Miller 已提交
3236 3237 3238 3239 3240
			break;
		}
		drv->queue = q;

		q->backing_dev_info.ra_pages = READ_AHEAD;
3241 3242 3243 3244
		blk_queue_bounce_limit(q, hba[i]->pdev->dma_mask);

		/* This is a hardware imposed limit. */
		blk_queue_max_hw_segments(q, MAXSGENTRIES);
L
Linus Torvalds 已提交
3245

3246 3247
		/* This is a limit in the driver and could be eliminated. */
		blk_queue_max_phys_segments(q, MAXSGENTRIES);
L
Linus Torvalds 已提交
3248

3249
		blk_queue_max_sectors(q, 512);
L
Linus Torvalds 已提交
3250

3251
		blk_queue_softirq_done(q, cciss_softirq_done);
L
Linus Torvalds 已提交
3252

M
Mike Miller 已提交
3253
		q->queuedata = hba[i];
L
Linus Torvalds 已提交
3254 3255 3256 3257
		sprintf(disk->disk_name, "cciss/c%dd%d", i, j);
		disk->major = hba[i]->major;
		disk->first_minor = j << NWD_SHIFT;
		disk->fops = &cciss_fops;
M
Mike Miller 已提交
3258
		disk->queue = q;
L
Linus Torvalds 已提交
3259
		disk->private_data = drv;
3260
		disk->driverfs_dev = &pdev->dev;
L
Linus Torvalds 已提交
3261 3262
		/* we must register the controller even if no disks exist */
		/* this is for the online array utilities */
3263
		if (!drv->heads && j)
L
Linus Torvalds 已提交
3264
			continue;
M
Mike Miller 已提交
3265
		blk_queue_hardsect_size(q, drv->block_size);
L
Linus Torvalds 已提交
3266 3267 3268
		set_capacity(disk, drv->nr_blocks);
		add_disk(disk);
	}
M
Mike Miller 已提交
3269

3270
	return 1;
L
Linus Torvalds 已提交
3271

3272
      clean4:
3273
#ifdef CONFIG_CISS_SCSI_TAPE
3274
	kfree(hba[i]->scsi_rejects.complete);
3275
#endif
3276
	kfree(hba[i]->cmd_pool_bits);
3277
	if (hba[i]->cmd_pool)
L
Linus Torvalds 已提交
3278
		pci_free_consistent(hba[i]->pdev,
3279 3280 3281
				    NR_CMDS * sizeof(CommandList_struct),
				    hba[i]->cmd_pool, hba[i]->cmd_pool_dhandle);
	if (hba[i]->errinfo_pool)
L
Linus Torvalds 已提交
3282
		pci_free_consistent(hba[i]->pdev,
3283 3284 3285
				    NR_CMDS * sizeof(ErrorInfo_struct),
				    hba[i]->errinfo_pool,
				    hba[i]->errinfo_pool_dhandle);
3286
	free_irq(hba[i]->intr[SIMPLE_MODE_INT], hba[i]);
3287
      clean2:
L
Linus Torvalds 已提交
3288
	unregister_blkdev(hba[i]->major, hba[i]->devname);
3289
      clean1:
3290
	hba[i]->busy_initializing = 0;
3291
	free_hba(i);
3292
	return -1;
L
Linus Torvalds 已提交
3293 3294
}

3295
static void __devexit cciss_remove_one(struct pci_dev *pdev)
L
Linus Torvalds 已提交
3296 3297 3298 3299
{
	ctlr_info_t *tmp_ptr;
	int i, j;
	char flush_buf[4];
3300
	int return_code;
L
Linus Torvalds 已提交
3301

3302 3303
	if (pci_get_drvdata(pdev) == NULL) {
		printk(KERN_ERR "cciss: Unable to remove device \n");
L
Linus Torvalds 已提交
3304 3305 3306 3307
		return;
	}
	tmp_ptr = pci_get_drvdata(pdev);
	i = tmp_ptr->ctlr;
3308
	if (hba[i] == NULL) {
L
Linus Torvalds 已提交
3309
		printk(KERN_ERR "cciss: device appears to "
3310
		       "already be removed \n");
L
Linus Torvalds 已提交
3311 3312 3313 3314
		return;
	}
	/* Turn board interrupts off  and send the flush cache command */
	/* sendcmd will turn off interrupt, and send the flush...
3315
	 * To write all data in the battery backed cache to disks */
L
Linus Torvalds 已提交
3316 3317
	memset(flush_buf, 0, 4);
	return_code = sendcmd(CCISS_CACHE_FLUSH, i, flush_buf, 4, 0, 0, 0, NULL,
3318 3319 3320 3321
			      TYPE_CMD);
	if (return_code != IO_OK) {
		printk(KERN_WARNING "Error Flushing cache on controller %d\n",
		       i);
L
Linus Torvalds 已提交
3322
	}
3323 3324 3325
	free_irq(hba[i]->intr[2], hba[i]);

#ifdef CONFIG_PCI_MSI
3326 3327 3328 3329 3330
	if (hba[i]->msix_vector)
		pci_disable_msix(hba[i]->pdev);
	else if (hba[i]->msi_vector)
		pci_disable_msi(hba[i]->pdev);
#endif				/* CONFIG_PCI_MSI */
3331

L
Linus Torvalds 已提交
3332
	iounmap(hba[i]->vaddr);
3333
	cciss_unregister_scsi(i);	/* unhook from SCSI subsystem */
L
Linus Torvalds 已提交
3334
	unregister_blkdev(hba[i]->major, hba[i]->devname);
3335 3336
	remove_proc_entry(hba[i]->devname, proc_cciss);

L
Linus Torvalds 已提交
3337 3338 3339
	/* remove it from the disk list */
	for (j = 0; j < NWD; j++) {
		struct gendisk *disk = hba[i]->gendisk[j];
3340 3341 3342
		if (disk) {
			request_queue_t *q = disk->queue;

3343
			if (disk->flags & GENHD_FL_UP)
3344 3345 3346
				del_gendisk(disk);
			if (q)
				blk_cleanup_queue(q);
3347
		}
L
Linus Torvalds 已提交
3348 3349 3350 3351
	}

	pci_free_consistent(hba[i]->pdev, NR_CMDS * sizeof(CommandList_struct),
			    hba[i]->cmd_pool, hba[i]->cmd_pool_dhandle);
3352 3353
	pci_free_consistent(hba[i]->pdev, NR_CMDS * sizeof(ErrorInfo_struct),
			    hba[i]->errinfo_pool, hba[i]->errinfo_pool_dhandle);
L
Linus Torvalds 已提交
3354
	kfree(hba[i]->cmd_pool_bits);
3355 3356 3357
#ifdef CONFIG_CISS_SCSI_TAPE
	kfree(hba[i]->scsi_rejects.complete);
#endif
3358
	pci_release_regions(pdev);
3359 3360
	pci_disable_device(pdev);
	pci_set_drvdata(pdev, NULL);
L
Linus Torvalds 已提交
3361
	free_hba(i);
3362
}
L
Linus Torvalds 已提交
3363 3364

static struct pci_driver cciss_pci_driver = {
3365 3366 3367 3368
	.name = "cciss",
	.probe = cciss_init_one,
	.remove = __devexit_p(cciss_remove_one),
	.id_table = cciss_pci_device_id,	/* id_table */
L
Linus Torvalds 已提交
3369 3370 3371 3372
};

/*
 *  This is it.  Register the PCI driver information for the cards we control
3373
 *  the OS will call our registered routines when it finds one of our cards.
L
Linus Torvalds 已提交
3374 3375 3376 3377 3378 3379
 */
static int __init cciss_init(void)
{
	printk(KERN_INFO DRIVER_NAME "\n");

	/* Register for our PCI devices */
3380
	return pci_register_driver(&cciss_pci_driver);
L
Linus Torvalds 已提交
3381 3382 3383 3384 3385 3386 3387 3388
}

static void __exit cciss_cleanup(void)
{
	int i;

	pci_unregister_driver(&cciss_pci_driver);
	/* double check that all controller entrys have been removed */
3389 3390
	for (i = 0; i < MAX_CTLR; i++) {
		if (hba[i] != NULL) {
L
Linus Torvalds 已提交
3391
			printk(KERN_WARNING "cciss: had to remove"
3392
			       " controller %d\n", i);
L
Linus Torvalds 已提交
3393 3394 3395 3396 3397 3398
			cciss_remove_one(hba[i]->pdev);
		}
	}
	remove_proc_entry("cciss", proc_root_driver);
}

3399 3400 3401 3402 3403 3404 3405 3406
static void fail_all_cmds(unsigned long ctlr)
{
	/* If we get here, the board is apparently dead. */
	ctlr_info_t *h = hba[ctlr];
	CommandList_struct *c;
	unsigned long flags;

	printk(KERN_WARNING "cciss%d: controller not responding.\n", h->ctlr);
3407
	h->alive = 0;		/* the controller apparently died... */
3408 3409 3410

	spin_lock_irqsave(CCISS_LOCK(ctlr), flags);

3411
	pci_disable_device(h->pdev);	/* Make sure it is really dead. */
3412 3413

	/* move everything off the request queue onto the completed queue */
3414
	while ((c = h->reqQ) != NULL) {
3415 3416
		removeQ(&(h->reqQ), c);
		h->Qdepth--;
3417
		addQ(&(h->cmpQ), c);
3418 3419 3420
	}

	/* Now, fail everything on the completed queue with a HW error */
3421
	while ((c = h->cmpQ) != NULL) {
3422 3423 3424 3425 3426 3427 3428
		removeQ(&h->cmpQ, c);
		c->err_info->CommandStatus = CMD_HARDWARE_ERR;
		if (c->cmd_type == CMD_RWREQ) {
			complete_command(h, c, 0);
		} else if (c->cmd_type == CMD_IOCTL_PEND)
			complete(c->waiting);
#ifdef CONFIG_CISS_SCSI_TAPE
3429 3430
		else if (c->cmd_type == CMD_SCSI)
			complete_scsi_command(c, 0, 0);
3431 3432 3433 3434 3435 3436
#endif
	}
	spin_unlock_irqrestore(CCISS_LOCK(ctlr), flags);
	return;
}

L
Linus Torvalds 已提交
3437 3438
module_init(cciss_init);
module_exit(cciss_cleanup);