1/* 2 * Disk Array driver for Compaq SMART2 Controllers 3 * Copyright 1998 Compaq Computer Corporation 4 * 5 * This program is free software; you can redistribute it and/or modify 6 * it under the terms of the GNU General Public License as published by 7 * the Free Software Foundation; either version 2 of the License, or 8 * (at your option) any later version. 9 * 10 * This program is distributed in the hope that it will be useful, 11 * but WITHOUT ANY WARRANTY; without even the implied warranty of 12 * MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE, GOOD TITLE or 13 * NON INFRINGEMENT. See the GNU General Public License for more details. 14 * 15 * You should have received a copy of the GNU General Public License 16 * along with this program; if not, write to the Free Software 17 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. 18 * 19 * Questions/Comments/Bugfixes to iss_storagedev@hp.com 20 * 21 */ 22#include <linux/module.h> 23#include <linux/types.h> 24#include <linux/pci.h> 25#include <linux/bio.h> 26#include <linux/interrupt.h> 27#include <linux/kernel.h> 28#include <linux/slab.h> 29#include <linux/delay.h> 30#include <linux/major.h> 31#include <linux/fs.h> 32#include <linux/blkpg.h> 33#include <linux/timer.h> 34#include <linux/proc_fs.h> 35#include <linux/init.h> 36#include <linux/hdreg.h> 37#include <linux/spinlock.h> 38#include <linux/blkdev.h> 39#include <linux/genhd.h> 40#include <asm/uaccess.h> 41#include <asm/io.h> 42 43 44#define SMART2_DRIVER_VERSION(maj,min,submin) ((maj<<16)|(min<<8)|(submin)) 45 46#define DRIVER_NAME "Compaq SMART2 Driver (v 2.6.0)" 47#define DRIVER_VERSION SMART2_DRIVER_VERSION(2,6,0) 48 49/* Embedded module documentation macros - see modules.h */ 50/* Original author Chris Frantz - Compaq Computer Corporation */ 51MODULE_AUTHOR("Compaq Computer Corporation"); 52MODULE_DESCRIPTION("Driver for Compaq Smart2 Array Controllers version 2.6.0"); 53MODULE_LICENSE("GPL"); 54 55#include "cpqarray.h" 56#include "ida_cmd.h" 57#include "smart1,2.h" 58#include "ida_ioctl.h" 59 60#define READ_AHEAD 128 61#define NR_CMDS 128 /* This could probably go as high as ~400 */ 62 63#define MAX_CTLR 8 64#define CTLR_SHIFT 8 65 66#define CPQARRAY_DMA_MASK 0xFFFFFFFF /* 32 bit DMA */ 67 68static int nr_ctlr; 69static ctlr_info_t *hba[MAX_CTLR]; 70 71static int eisa[8]; 72 73#define NR_PRODUCTS ARRAY_SIZE(products) 74 75/* board_id = Subsystem Device ID & Vendor ID 76 * product = Marketing Name for the board 77 * access = Address of the struct of function pointers 78 */ 79static struct board_type products[] = { 80 { 0x0040110E, "IDA", &smart1_access }, 81 { 0x0140110E, "IDA-2", &smart1_access }, 82 { 0x1040110E, "IAES", &smart1_access }, 83 { 0x2040110E, "SMART", &smart1_access }, 84 { 0x3040110E, "SMART-2/E", &smart2e_access }, 85 { 0x40300E11, "SMART-2/P", &smart2_access }, 86 { 0x40310E11, "SMART-2SL", &smart2_access }, 87 { 0x40320E11, "Smart Array 3200", &smart2_access }, 88 { 0x40330E11, "Smart Array 3100ES", &smart2_access }, 89 { 0x40340E11, "Smart Array 221", &smart2_access }, 90 { 0x40400E11, "Integrated Array", &smart4_access }, 91 { 0x40480E11, "Compaq Raid LC2", &smart4_access }, 92 { 0x40500E11, "Smart Array 4200", &smart4_access }, 93 { 0x40510E11, "Smart Array 4250ES", &smart4_access }, 94 { 0x40580E11, "Smart Array 431", &smart4_access }, 95}; 96 97/* define the PCI info for the PCI cards this driver can control */ 98static const struct pci_device_id cpqarray_pci_device_id[] = 99{ 100 { PCI_VENDOR_ID_DEC, PCI_DEVICE_ID_COMPAQ_42XX, 101 0x0E11, 0x4058, 0, 0, 0}, /* SA431 */ 102 { PCI_VENDOR_ID_DEC, PCI_DEVICE_ID_COMPAQ_42XX, 103 0x0E11, 0x4051, 0, 0, 0}, /* SA4250ES */ 104 { PCI_VENDOR_ID_DEC, PCI_DEVICE_ID_COMPAQ_42XX, 105 0x0E11, 0x4050, 0, 0, 0}, /* SA4200 */ 106 { PCI_VENDOR_ID_NCR, PCI_DEVICE_ID_NCR_53C1510, 107 0x0E11, 0x4048, 0, 0, 0}, /* LC2 */ 108 { PCI_VENDOR_ID_NCR, PCI_DEVICE_ID_NCR_53C1510, 109 0x0E11, 0x4040, 0, 0, 0}, /* Integrated Array */ 110 { PCI_VENDOR_ID_COMPAQ, PCI_DEVICE_ID_COMPAQ_SMART2P, 111 0x0E11, 0x4034, 0, 0, 0}, /* SA 221 */ 112 { PCI_VENDOR_ID_COMPAQ, PCI_DEVICE_ID_COMPAQ_SMART2P, 113 0x0E11, 0x4033, 0, 0, 0}, /* SA 3100ES*/ 114 { PCI_VENDOR_ID_COMPAQ, PCI_DEVICE_ID_COMPAQ_SMART2P, 115 0x0E11, 0x4032, 0, 0, 0}, /* SA 3200*/ 116 { PCI_VENDOR_ID_COMPAQ, PCI_DEVICE_ID_COMPAQ_SMART2P, 117 0x0E11, 0x4031, 0, 0, 0}, /* SA 2SL*/ 118 { PCI_VENDOR_ID_COMPAQ, PCI_DEVICE_ID_COMPAQ_SMART2P, 119 0x0E11, 0x4030, 0, 0, 0}, /* SA 2P */ 120 { 0 } 121}; 122 123MODULE_DEVICE_TABLE(pci, cpqarray_pci_device_id); 124 125static struct gendisk *ida_gendisk[MAX_CTLR][NWD]; 126 127/* Debug... */ 128#define DBG(s) do { s } while(0) 129/* Debug (general info)... */ 130#define DBGINFO(s) do { } while(0) 131/* Debug Paranoid... */ 132#define DBGP(s) do { } while(0) 133/* Debug Extra Paranoid... */ 134#define DBGPX(s) do { } while(0) 135 136static int cpqarray_pci_init(ctlr_info_t *c, struct pci_dev *pdev); 137static void __iomem *remap_pci_mem(ulong base, ulong size); 138static int cpqarray_eisa_detect(void); 139static int pollcomplete(int ctlr); 140static void getgeometry(int ctlr); 141static void start_fwbk(int ctlr); 142 143static cmdlist_t * cmd_alloc(ctlr_info_t *h, int get_from_pool); 144static void cmd_free(ctlr_info_t *h, cmdlist_t *c, int got_from_pool); 145 146static void free_hba(int i); 147static int alloc_cpqarray_hba(void); 148 149static int sendcmd( 150 __u8 cmd, 151 int ctlr, 152 void *buff, 153 size_t size, 154 unsigned int blk, 155 unsigned int blkcnt, 156 unsigned int log_unit ); 157 158static int ida_open(struct inode *inode, struct file *filep); 159static int ida_release(struct inode *inode, struct file *filep); 160static int ida_ioctl(struct inode *inode, struct file *filep, unsigned int cmd, unsigned long arg); 161static int ida_getgeo(struct block_device *bdev, struct hd_geometry *geo); 162static int ida_ctlr_ioctl(ctlr_info_t *h, int dsk, ida_ioctl_t *io); 163 164static void do_ida_request(request_queue_t *q); 165static void start_io(ctlr_info_t *h); 166 167static inline void addQ(cmdlist_t **Qptr, cmdlist_t *c); 168static inline cmdlist_t *removeQ(cmdlist_t **Qptr, cmdlist_t *c); 169static inline void complete_buffers(struct bio *bio, int ok); 170static inline void complete_command(cmdlist_t *cmd, int timeout); 171 172static irqreturn_t do_ida_intr(int irq, void *dev_id); 173static void ida_timer(unsigned long tdata); 174static int ida_revalidate(struct gendisk *disk); 175static int revalidate_allvol(ctlr_info_t *host); 176static int cpqarray_register_ctlr(int ctlr, struct pci_dev *pdev); 177 178#ifdef CONFIG_PROC_FS 179static void ida_procinit(int i); 180static int ida_proc_get_info(char *buffer, char **start, off_t offset, int length, int *eof, void *data); 181#else 182static void ida_procinit(int i) {} 183#endif 184 185static inline drv_info_t *get_drv(struct gendisk *disk) 186{ 187 return disk->private_data; 188} 189 190static inline ctlr_info_t *get_host(struct gendisk *disk) 191{ 192 return disk->queue->queuedata; 193} 194 195 196static struct block_device_operations ida_fops = { 197 .owner = THIS_MODULE, 198 .open = ida_open, 199 .release = ida_release, 200 .ioctl = ida_ioctl, 201 .getgeo = ida_getgeo, 202 .revalidate_disk= ida_revalidate, 203}; 204 205 206#ifdef CONFIG_PROC_FS 207 208static struct proc_dir_entry *proc_array; 209 210/* 211 * Get us a file in /proc/array that says something about each controller. 212 * Create /proc/array if it doesn't exist yet. 213 */ 214static void __init ida_procinit(int i) 215{ 216 if (proc_array == NULL) { 217 proc_array = proc_mkdir("cpqarray", proc_root_driver); 218 if (!proc_array) return; 219 } 220 221 create_proc_read_entry(hba[i]->devname, 0, proc_array, 222 ida_proc_get_info, hba[i]); 223} 224 225/* 226 * Report information about this controller. 227 */ 228static int ida_proc_get_info(char *buffer, char **start, off_t offset, int length, int *eof, void *data) 229{ 230 off_t pos = 0; 231 off_t len = 0; 232 int size, i, ctlr; 233 ctlr_info_t *h = (ctlr_info_t*)data; 234 drv_info_t *drv; 235#ifdef CPQ_PROC_PRINT_QUEUES 236 cmdlist_t *c; 237 unsigned long flags; 238#endif 239 240 ctlr = h->ctlr; 241 size = sprintf(buffer, "%s: Compaq %s Controller\n" 242 " Board ID: 0x%08lx\n" 243 " Firmware Revision: %c%c%c%c\n" 244 " Controller Sig: 0x%08lx\n" 245 " Memory Address: 0x%08lx\n" 246 " I/O Port: 0x%04x\n" 247 " IRQ: %d\n" 248 " Logical drives: %d\n" 249 " Physical drives: %d\n\n" 250 " Current Q depth: %d\n" 251 " Max Q depth since init: %d\n\n", 252 h->devname, 253 h->product_name, 254 (unsigned long)h->board_id, 255 h->firm_rev[0], h->firm_rev[1], h->firm_rev[2], h->firm_rev[3], 256 (unsigned long)h->ctlr_sig, (unsigned long)h->vaddr, 257 (unsigned int) h->io_mem_addr, (unsigned int)h->intr, 258 h->log_drives, h->phys_drives, 259 h->Qdepth, h->maxQsinceinit); 260 261 pos += size; len += size; 262 263 size = sprintf(buffer+len, "Logical Drive Info:\n"); 264 pos += size; len += size; 265 266 for(i=0; i<h->log_drives; i++) { 267 drv = &h->drv[i]; 268 size = sprintf(buffer+len, "ida/c%dd%d: blksz=%d nr_blks=%d\n", 269 ctlr, i, drv->blk_size, drv->nr_blks); 270 pos += size; len += size; 271 } 272 273#ifdef CPQ_PROC_PRINT_QUEUES 274 spin_lock_irqsave(IDA_LOCK(h->ctlr), flags); 275 size = sprintf(buffer+len, "\nCurrent Queues:\n"); 276 pos += size; len += size; 277 278 c = h->reqQ; 279 size = sprintf(buffer+len, "reqQ = %p", c); pos += size; len += size; 280 if (c) c=c->next; 281 while(c && c != h->reqQ) { 282 size = sprintf(buffer+len, "->%p", c); 283 pos += size; len += size; 284 c=c->next; 285 } 286 287 c = h->cmpQ; 288 size = sprintf(buffer+len, "\ncmpQ = %p", c); pos += size; len += size; 289 if (c) c=c->next; 290 while(c && c != h->cmpQ) { 291 size = sprintf(buffer+len, "->%p", c); 292 pos += size; len += size; 293 c=c->next; 294 } 295 296 size = sprintf(buffer+len, "\n"); pos += size; len += size; 297 spin_unlock_irqrestore(IDA_LOCK(h->ctlr), flags); 298#endif 299 size = sprintf(buffer+len, "nr_allocs = %d\nnr_frees = %d\n", 300 h->nr_allocs, h->nr_frees); 301 pos += size; len += size; 302 303 *eof = 1; 304 *start = buffer+offset; 305 len -= offset; 306 if (len>length) 307 len = length; 308 return len; 309} 310#endif /* CONFIG_PROC_FS */ 311 312module_param_array(eisa, int, NULL, 0); 313 314static void release_io_mem(ctlr_info_t *c) 315{ 316 /* if IO mem was not protected do nothing */ 317 if( c->io_mem_addr == 0) 318 return; 319 release_region(c->io_mem_addr, c->io_mem_length); 320 c->io_mem_addr = 0; 321 c->io_mem_length = 0; 322} 323 324static void __devexit cpqarray_remove_one(int i) 325{ 326 int j; 327 char buff[4]; 328 329 /* sendcmd will turn off interrupt, and send the flush... 330 * To write all data in the battery backed cache to disks 331 * no data returned, but don't want to send NULL to sendcmd */ 332 if( sendcmd(FLUSH_CACHE, i, buff, 4, 0, 0, 0)) 333 { 334 printk(KERN_WARNING "Unable to flush cache on controller %d\n", 335 i); 336 } 337 free_irq(hba[i]->intr, hba[i]); 338 iounmap(hba[i]->vaddr); 339 unregister_blkdev(COMPAQ_SMART2_MAJOR+i, hba[i]->devname); 340 del_timer(&hba[i]->timer); 341 remove_proc_entry(hba[i]->devname, proc_array); 342 pci_free_consistent(hba[i]->pci_dev, 343 NR_CMDS * sizeof(cmdlist_t), (hba[i]->cmd_pool), 344 hba[i]->cmd_pool_dhandle); 345 kfree(hba[i]->cmd_pool_bits); 346 for(j = 0; j < NWD; j++) { 347 if (ida_gendisk[i][j]->flags & GENHD_FL_UP) 348 del_gendisk(ida_gendisk[i][j]); 349 put_disk(ida_gendisk[i][j]); 350 } 351 blk_cleanup_queue(hba[i]->queue); 352 release_io_mem(hba[i]); 353 free_hba(i); 354} 355 356static void __devexit cpqarray_remove_one_pci (struct pci_dev *pdev) 357{ 358 int i; 359 ctlr_info_t *tmp_ptr; 360 361 if (pci_get_drvdata(pdev) == NULL) { 362 printk( KERN_ERR "cpqarray: Unable to remove device \n"); 363 return; 364 } 365 366 tmp_ptr = pci_get_drvdata(pdev); 367 i = tmp_ptr->ctlr; 368 if (hba[i] == NULL) { 369 printk(KERN_ERR "cpqarray: controller %d appears to have" 370 "already been removed \n", i); 371 return; 372 } 373 pci_set_drvdata(pdev, NULL); 374 375 cpqarray_remove_one(i); 376} 377 378/* removing an instance that was not removed automatically.. 379 * must be an eisa card. 380 */ 381static void __devexit cpqarray_remove_one_eisa (int i) 382{ 383 if (hba[i] == NULL) { 384 printk(KERN_ERR "cpqarray: controller %d appears to have" 385 "already been removed \n", i); 386 return; 387 } 388 cpqarray_remove_one(i); 389} 390 391/* pdev is NULL for eisa */ 392static int __init cpqarray_register_ctlr( int i, struct pci_dev *pdev) 393{ 394 request_queue_t *q; 395 int j; 396 397 /* 398 * register block devices 399 * Find disks and fill in structs 400 * Get an interrupt, set the Q depth and get into /proc 401 */ 402 403 /* If this successful it should insure that we are the only */ 404 /* instance of the driver */ 405 if (register_blkdev(COMPAQ_SMART2_MAJOR+i, hba[i]->devname)) { 406 goto Enomem4; 407 } 408 hba[i]->access.set_intr_mask(hba[i], 0); 409 if (request_irq(hba[i]->intr, do_ida_intr, 410 IRQF_DISABLED|IRQF_SHARED, hba[i]->devname, hba[i])) 411 { 412 printk(KERN_ERR "cpqarray: Unable to get irq %d for %s\n", 413 hba[i]->intr, hba[i]->devname); 414 goto Enomem3; 415 } 416 417 for (j=0; j<NWD; j++) { 418 ida_gendisk[i][j] = alloc_disk(1 << NWD_SHIFT); 419 if (!ida_gendisk[i][j]) 420 goto Enomem2; 421 } 422 423 hba[i]->cmd_pool = (cmdlist_t *)pci_alloc_consistent( 424 hba[i]->pci_dev, NR_CMDS * sizeof(cmdlist_t), 425 &(hba[i]->cmd_pool_dhandle)); 426 hba[i]->cmd_pool_bits = kmalloc( 427 ((NR_CMDS+BITS_PER_LONG-1)/BITS_PER_LONG)*sizeof(unsigned long), 428 GFP_KERNEL); 429 430 if (!hba[i]->cmd_pool_bits || !hba[i]->cmd_pool) 431 goto Enomem1; 432 433 memset(hba[i]->cmd_pool, 0, NR_CMDS * sizeof(cmdlist_t)); 434 memset(hba[i]->cmd_pool_bits, 0, ((NR_CMDS+BITS_PER_LONG-1)/BITS_PER_LONG)*sizeof(unsigned long)); 435 printk(KERN_INFO "cpqarray: Finding drives on %s", 436 hba[i]->devname); 437 438 spin_lock_init(&hba[i]->lock); 439 q = blk_init_queue(do_ida_request, &hba[i]->lock); 440 if (!q) 441 goto Enomem1; 442 443 hba[i]->queue = q; 444 q->queuedata = hba[i]; 445 446 getgeometry(i); 447 start_fwbk(i); 448 449 ida_procinit(i); 450 451 if (pdev) 452 blk_queue_bounce_limit(q, hba[i]->pci_dev->dma_mask); 453 454 /* This is a hardware imposed limit. */ 455 blk_queue_max_hw_segments(q, SG_MAX); 456 457 /* This is a driver limit and could be eliminated. */ 458 blk_queue_max_phys_segments(q, SG_MAX); 459 460 init_timer(&hba[i]->timer); 461 hba[i]->timer.expires = jiffies + IDA_TIMER; 462 hba[i]->timer.data = (unsigned long)hba[i]; 463 hba[i]->timer.function = ida_timer; 464 add_timer(&hba[i]->timer); 465 466 /* Enable IRQ now that spinlock and rate limit timer are set up */ 467 hba[i]->access.set_intr_mask(hba[i], FIFO_NOT_EMPTY); 468 469 for(j=0; j<NWD; j++) { 470 struct gendisk *disk = ida_gendisk[i][j]; 471 drv_info_t *drv = &hba[i]->drv[j]; 472 sprintf(disk->disk_name, "ida/c%dd%d", i, j); 473 disk->major = COMPAQ_SMART2_MAJOR + i; 474 disk->first_minor = j<<NWD_SHIFT; 475 disk->fops = &ida_fops; 476 if (j && !drv->nr_blks) 477 continue; 478 blk_queue_hardsect_size(hba[i]->queue, drv->blk_size); 479 set_capacity(disk, drv->nr_blks); 480 disk->queue = hba[i]->queue; 481 disk->private_data = drv; 482 add_disk(disk); 483 } 484 485 /* done ! */ 486 return(i); 487 488Enomem1: 489 nr_ctlr = i; 490 kfree(hba[i]->cmd_pool_bits); 491 if (hba[i]->cmd_pool) 492 pci_free_consistent(hba[i]->pci_dev, NR_CMDS*sizeof(cmdlist_t), 493 hba[i]->cmd_pool, hba[i]->cmd_pool_dhandle); 494Enomem2: 495 while (j--) { 496 put_disk(ida_gendisk[i][j]); 497 ida_gendisk[i][j] = NULL; 498 } 499 free_irq(hba[i]->intr, hba[i]); 500Enomem3: 501 unregister_blkdev(COMPAQ_SMART2_MAJOR+i, hba[i]->devname); 502Enomem4: 503 if (pdev) 504 pci_set_drvdata(pdev, NULL); 505 release_io_mem(hba[i]); 506 free_hba(i); 507 508 printk( KERN_ERR "cpqarray: out of memory"); 509 510 return -1; 511} 512 513static int __init cpqarray_init_one( struct pci_dev *pdev, 514 const struct pci_device_id *ent) 515{ 516 int i; 517 518 printk(KERN_DEBUG "cpqarray: Device 0x%x has been found at" 519 " bus %d dev %d func %d\n", 520 pdev->device, pdev->bus->number, PCI_SLOT(pdev->devfn), 521 PCI_FUNC(pdev->devfn)); 522 i = alloc_cpqarray_hba(); 523 if( i < 0 ) 524 return (-1); 525 memset(hba[i], 0, sizeof(ctlr_info_t)); 526 sprintf(hba[i]->devname, "ida%d", i); 527 hba[i]->ctlr = i; 528 /* Initialize the pdev driver private data */ 529 pci_set_drvdata(pdev, hba[i]); 530 531 if (cpqarray_pci_init(hba[i], pdev) != 0) { 532 pci_set_drvdata(pdev, NULL); 533 release_io_mem(hba[i]); 534 free_hba(i); 535 return -1; 536 } 537 538 return (cpqarray_register_ctlr(i, pdev)); 539} 540 541static struct pci_driver cpqarray_pci_driver = { 542 .name = "cpqarray", 543 .probe = cpqarray_init_one, 544 .remove = __devexit_p(cpqarray_remove_one_pci), 545 .id_table = cpqarray_pci_device_id, 546}; 547 548/* 549 * This is it. Find all the controllers and register them. 550 * returns the number of block devices registered. 551 */ 552static int __init cpqarray_init(void) 553{ 554 int num_cntlrs_reg = 0; 555 int i; 556 int rc = 0; 557 558 /* detect controllers */ 559 printk(DRIVER_NAME "\n"); 560 561 rc = pci_register_driver(&cpqarray_pci_driver); 562 if (rc) 563 return rc; 564 cpqarray_eisa_detect(); 565 566 for (i=0; i < MAX_CTLR; i++) { 567 if (hba[i] != NULL) 568 num_cntlrs_reg++; 569 } 570 571 return(num_cntlrs_reg); 572} 573 574/* Function to find the first free pointer into our hba[] array */ 575/* Returns -1 if no free entries are left. */ 576static int alloc_cpqarray_hba(void) 577{ 578 int i; 579 580 for(i=0; i< MAX_CTLR; i++) { 581 if (hba[i] == NULL) { 582 hba[i] = kmalloc(sizeof(ctlr_info_t), GFP_KERNEL); 583 if(hba[i]==NULL) { 584 printk(KERN_ERR "cpqarray: out of memory.\n"); 585 return (-1); 586 } 587 return (i); 588 } 589 } 590 printk(KERN_WARNING "cpqarray: This driver supports a maximum" 591 " of 8 controllers.\n"); 592 return(-1); 593} 594 595static void free_hba(int i) 596{ 597 kfree(hba[i]); 598 hba[i]=NULL; 599} 600 601/* 602 * Find the IO address of the controller, its IRQ and so forth. Fill 603 * in some basic stuff into the ctlr_info_t structure. 604 */ 605static int cpqarray_pci_init(ctlr_info_t *c, struct pci_dev *pdev) 606{ 607 ushort vendor_id, device_id, command; 608 unchar cache_line_size, latency_timer; 609 unchar irq, revision; 610 unsigned long addr[6]; 611 __u32 board_id; 612 613 int i; 614 615 c->pci_dev = pdev; 616 if (pci_enable_device(pdev)) { 617 printk(KERN_ERR "cpqarray: Unable to Enable PCI device\n"); 618 return -1; 619 } 620 vendor_id = pdev->vendor; 621 device_id = pdev->device; 622 irq = pdev->irq; 623 624 for(i=0; i<6; i++) 625 addr[i] = pci_resource_start(pdev, i); 626 627 if (pci_set_dma_mask(pdev, CPQARRAY_DMA_MASK) != 0) 628 { 629 printk(KERN_ERR "cpqarray: Unable to set DMA mask\n"); 630 return -1; 631 } 632 633 pci_read_config_word(pdev, PCI_COMMAND, &command); 634 pci_read_config_byte(pdev, PCI_CLASS_REVISION, &revision); 635 pci_read_config_byte(pdev, PCI_CACHE_LINE_SIZE, &cache_line_size); 636 pci_read_config_byte(pdev, PCI_LATENCY_TIMER, &latency_timer); 637 638 pci_read_config_dword(pdev, 0x2c, &board_id); 639 640 /* check to see if controller has been disabled */ 641 if(!(command & 0x02)) { 642 printk(KERN_WARNING 643 "cpqarray: controller appears to be disabled\n"); 644 return(-1); 645 } 646 647DBGINFO( 648 printk("vendor_id = %x\n", vendor_id); 649 printk("device_id = %x\n", device_id); 650 printk("command = %x\n", command); 651 for(i=0; i<6; i++) 652 printk("addr[%d] = %lx\n", i, addr[i]); 653 printk("revision = %x\n", revision); 654 printk("irq = %x\n", irq); 655 printk("cache_line_size = %x\n", cache_line_size); 656 printk("latency_timer = %x\n", latency_timer); 657 printk("board_id = %x\n", board_id); 658); 659 660 c->intr = irq; 661 662 for(i=0; i<6; i++) { 663 if (pci_resource_flags(pdev, i) & PCI_BASE_ADDRESS_SPACE_IO) 664 { /* IO space */ 665 c->io_mem_addr = addr[i]; 666 c->io_mem_length = pci_resource_end(pdev, i) 667 - pci_resource_start(pdev, i) + 1; 668 if(!request_region( c->io_mem_addr, c->io_mem_length, 669 "cpqarray")) 670 { 671 printk( KERN_WARNING "cpqarray I/O memory range already in use addr %lx length = %ld\n", c->io_mem_addr, c->io_mem_length); 672 c->io_mem_addr = 0; 673 c->io_mem_length = 0; 674 } 675 break; 676 } 677 } 678 679 c->paddr = 0; 680 for(i=0; i<6; i++) 681 if (!(pci_resource_flags(pdev, i) & 682 PCI_BASE_ADDRESS_SPACE_IO)) { 683 c->paddr = pci_resource_start (pdev, i); 684 break; 685 } 686 if (!c->paddr) 687 return -1; 688 c->vaddr = remap_pci_mem(c->paddr, 128); 689 if (!c->vaddr) 690 return -1; 691 c->board_id = board_id; 692 693 for(i=0; i<NR_PRODUCTS; i++) { 694 if (board_id == products[i].board_id) { 695 c->product_name = products[i].product_name; 696 c->access = *(products[i].access); 697 break; 698 } 699 } 700 if (i == NR_PRODUCTS) { 701 printk(KERN_WARNING "cpqarray: Sorry, I don't know how" 702 " to access the SMART Array controller %08lx\n", 703 (unsigned long)board_id); 704 return -1; 705 } 706 707 return 0; 708} 709 710/* 711 * Map (physical) PCI mem into (virtual) kernel space 712 */ 713static void __iomem *remap_pci_mem(ulong base, ulong size) 714{ 715 ulong page_base = ((ulong) base) & PAGE_MASK; 716 ulong page_offs = ((ulong) base) - page_base; 717 void __iomem *page_remapped = ioremap(page_base, page_offs+size); 718 719 return (page_remapped ? (page_remapped + page_offs) : NULL); 720} 721 722#ifndef MODULE 723/* 724 * Config string is a comma separated set of i/o addresses of EISA cards. 725 */ 726static int cpqarray_setup(char *str) 727{ 728 int i, ints[9]; 729 730 (void)get_options(str, ARRAY_SIZE(ints), ints); 731 732 for(i=0; i<ints[0] && i<8; i++) 733 eisa[i] = ints[i+1]; 734 return 1; 735} 736 737__setup("smart2=", cpqarray_setup); 738 739#endif 740 741/* 742 * Find an EISA controller's signature. Set up an hba if we find it. 743 */ 744static int __init cpqarray_eisa_detect(void) 745{ 746 int i=0, j; 747 __u32 board_id; 748 int intr; 749 int ctlr; 750 int num_ctlr = 0; 751 752 while(i<8 && eisa[i]) { 753 ctlr = alloc_cpqarray_hba(); 754 if(ctlr == -1) 755 break; 756 board_id = inl(eisa[i]+0xC80); 757 for(j=0; j < NR_PRODUCTS; j++) 758 if (board_id == products[j].board_id) 759 break; 760 761 if (j == NR_PRODUCTS) { 762 printk(KERN_WARNING "cpqarray: Sorry, I don't know how" 763 " to access the SMART Array controller %08lx\n", (unsigned long)board_id); 764 continue; 765 } 766 767 memset(hba[ctlr], 0, sizeof(ctlr_info_t)); 768 hba[ctlr]->io_mem_addr = eisa[i]; 769 hba[ctlr]->io_mem_length = 0x7FF; 770 if(!request_region(hba[ctlr]->io_mem_addr, 771 hba[ctlr]->io_mem_length, 772 "cpqarray")) 773 { 774 printk(KERN_WARNING "cpqarray: I/O range already in " 775 "use addr = %lx length = %ld\n", 776 hba[ctlr]->io_mem_addr, 777 hba[ctlr]->io_mem_length); 778 free_hba(ctlr); 779 continue; 780 } 781 782 /* 783 * Read the config register to find our interrupt 784 */ 785 intr = inb(eisa[i]+0xCC0) >> 4; 786 if (intr & 1) intr = 11; 787 else if (intr & 2) intr = 10; 788 else if (intr & 4) intr = 14; 789 else if (intr & 8) intr = 15; 790 791 hba[ctlr]->intr = intr; 792 sprintf(hba[ctlr]->devname, "ida%d", nr_ctlr); 793 hba[ctlr]->product_name = products[j].product_name; 794 hba[ctlr]->access = *(products[j].access); 795 hba[ctlr]->ctlr = ctlr; 796 hba[ctlr]->board_id = board_id; 797 hba[ctlr]->pci_dev = NULL; /* not PCI */ 798 799DBGINFO( 800 printk("i = %d, j = %d\n", i, j); 801 printk("irq = %x\n", intr); 802 printk("product name = %s\n", products[j].product_name); 803 printk("board_id = %x\n", board_id); 804); 805 806 num_ctlr++; 807 i++; 808 809 if (cpqarray_register_ctlr(ctlr, NULL) == -1) 810 printk(KERN_WARNING 811 "cpqarray: Can't register EISA controller %d\n", 812 ctlr); 813 814 } 815 816 return num_ctlr; 817} 818 819/* 820 * Open. Make sure the device is really there. 821 */ 822static int ida_open(struct inode *inode, struct file *filep) 823{ 824 drv_info_t *drv = get_drv(inode->i_bdev->bd_disk); 825 ctlr_info_t *host = get_host(inode->i_bdev->bd_disk); 826 827 DBGINFO(printk("ida_open %s\n", inode->i_bdev->bd_disk->disk_name)); 828 /* 829 * Root is allowed to open raw volume zero even if it's not configured 830 * so array config can still work. I don't think I really like this, 831 * but I'm already using way to many device nodes to claim another one 832 * for "raw controller". 833 */ 834 if (!drv->nr_blks) { 835 if (!capable(CAP_SYS_RAWIO)) 836 return -ENXIO; 837 if (!capable(CAP_SYS_ADMIN) && drv != host->drv) 838 return -ENXIO; 839 } 840 host->usage_count++; 841 return 0; 842} 843 844/* 845 * Close. Sync first. 846 */ 847static int ida_release(struct inode *inode, struct file *filep) 848{ 849 ctlr_info_t *host = get_host(inode->i_bdev->bd_disk); 850 host->usage_count--; 851 return 0; 852} 853 854/* 855 * Enqueuing and dequeuing functions for cmdlists. 856 */ 857static inline void addQ(cmdlist_t **Qptr, cmdlist_t *c) 858{ 859 if (*Qptr == NULL) { 860 *Qptr = c; 861 c->next = c->prev = c; 862 } else { 863 c->prev = (*Qptr)->prev; 864 c->next = (*Qptr); 865 (*Qptr)->prev->next = c; 866 (*Qptr)->prev = c; 867 } 868} 869 870static inline cmdlist_t *removeQ(cmdlist_t **Qptr, cmdlist_t *c) 871{ 872 if (c && c->next != c) { 873 if (*Qptr == c) *Qptr = c->next; 874 c->prev->next = c->next; 875 c->next->prev = c->prev; 876 } else { 877 *Qptr = NULL; 878 } 879 return c; 880} 881 882/* 883 * Get a request and submit it to the controller. 884 * This routine needs to grab all the requests it possibly can from the 885 * req Q and submit them. Interrupts are off (and need to be off) when you 886 * are in here (either via the dummy do_ida_request functions or by being 887 * called from the interrupt handler 888 */ 889static void do_ida_request(request_queue_t *q) 890{ 891 ctlr_info_t *h = q->queuedata; 892 cmdlist_t *c; 893 struct request *creq; 894 struct scatterlist tmp_sg[SG_MAX]; 895 int i, dir, seg; 896 897 if (blk_queue_plugged(q)) 898 goto startio; 899 900queue_next: 901 creq = elv_next_request(q); 902 if (!creq) 903 goto startio; 904 905 BUG_ON(creq->nr_phys_segments > SG_MAX); 906 907 if ((c = cmd_alloc(h,1)) == NULL) 908 goto startio; 909 910 blkdev_dequeue_request(creq); 911 912 c->ctlr = h->ctlr; 913 c->hdr.unit = (drv_info_t *)(creq->rq_disk->private_data) - h->drv; 914 c->hdr.size = sizeof(rblk_t) >> 2; 915 c->size += sizeof(rblk_t); 916 917 c->req.hdr.blk = creq->sector; 918 c->rq = creq; 919DBGPX( 920 printk("sector=%d, nr_sectors=%d\n", creq->sector, creq->nr_sectors); 921); 922 seg = blk_rq_map_sg(q, creq, tmp_sg); 923 924 /* Now do all the DMA Mappings */ 925 if (rq_data_dir(creq) == READ) 926 dir = PCI_DMA_FROMDEVICE; 927 else 928 dir = PCI_DMA_TODEVICE; 929 for( i=0; i < seg; i++) 930 { 931 c->req.sg[i].size = tmp_sg[i].length; 932 c->req.sg[i].addr = (__u32) pci_map_page(h->pci_dev, 933 tmp_sg[i].page, 934 tmp_sg[i].offset, 935 tmp_sg[i].length, dir); 936 } 937DBGPX( printk("Submitting %d sectors in %d segments\n", creq->nr_sectors, seg); ); 938 c->req.hdr.sg_cnt = seg; 939 c->req.hdr.blk_cnt = creq->nr_sectors; 940 c->req.hdr.cmd = (rq_data_dir(creq) == READ) ? IDA_READ : IDA_WRITE; 941 c->type = CMD_RWREQ; 942 943 /* Put the request on the tail of the request queue */ 944 addQ(&h->reqQ, c); 945 h->Qdepth++; 946 if (h->Qdepth > h->maxQsinceinit) 947 h->maxQsinceinit = h->Qdepth; 948 949 goto queue_next; 950 951startio: 952 start_io(h); 953} 954 955/* 956 * start_io submits everything on a controller's request queue 957 * and moves it to the completion queue. 958 * 959 * Interrupts had better be off if you're in here 960 */ 961static void start_io(ctlr_info_t *h) 962{ 963 cmdlist_t *c; 964 965 while((c = h->reqQ) != NULL) { 966 /* Can't do anything if we're busy */ 967 if (h->access.fifo_full(h) == 0) 968 return; 969 970 /* Get the first entry from the request Q */ 971 removeQ(&h->reqQ, c); 972 h->Qdepth--; 973 974 /* Tell the controller to do our bidding */ 975 h->access.submit_command(h, c); 976 977 /* Get onto the completion Q */ 978 addQ(&h->cmpQ, c); 979 } 980} 981 982static inline void complete_buffers(struct bio *bio, int ok) 983{ 984 struct bio *xbh; 985 while(bio) { 986 int nr_sectors = bio_sectors(bio); 987 988 xbh = bio->bi_next; 989 bio->bi_next = NULL; 990 991 bio_endio(bio, nr_sectors << 9, ok ? 0 : -EIO); 992 993 bio = xbh; 994 } 995} 996/* 997 * Mark all buffers that cmd was responsible for 998 */ 999static inline void complete_command(cmdlist_t *cmd, int timeout) 1000{ 1001 int ok=1; 1002 int i, ddir; 1003 1004 if (cmd->req.hdr.rcode & RCODE_NONFATAL && 1005 (hba[cmd->ctlr]->misc_tflags & MISC_NONFATAL_WARN) == 0) { 1006 printk(KERN_NOTICE "Non Fatal error on ida/c%dd%d\n", 1007 cmd->ctlr, cmd->hdr.unit); 1008 hba[cmd->ctlr]->misc_tflags |= MISC_NONFATAL_WARN; 1009 } 1010 if (cmd->req.hdr.rcode & RCODE_FATAL) { 1011 printk(KERN_WARNING "Fatal error on ida/c%dd%d\n", 1012 cmd->ctlr, cmd->hdr.unit); 1013 ok = 0; 1014 } 1015 if (cmd->req.hdr.rcode & RCODE_INVREQ) { 1016 printk(KERN_WARNING "Invalid request on ida/c%dd%d = (cmd=%x sect=%d cnt=%d sg=%d ret=%x)\n", 1017 cmd->ctlr, cmd->hdr.unit, cmd->req.hdr.cmd, 1018 cmd->req.hdr.blk, cmd->req.hdr.blk_cnt, 1019 cmd->req.hdr.sg_cnt, cmd->req.hdr.rcode); 1020 ok = 0; 1021 } 1022 if (timeout) ok = 0; 1023 /* unmap the DMA mapping for all the scatter gather elements */ 1024 if (cmd->req.hdr.cmd == IDA_READ) 1025 ddir = PCI_DMA_FROMDEVICE; 1026 else 1027 ddir = PCI_DMA_TODEVICE; 1028 for(i=0; i<cmd->req.hdr.sg_cnt; i++) 1029 pci_unmap_page(hba[cmd->ctlr]->pci_dev, cmd->req.sg[i].addr, 1030 cmd->req.sg[i].size, ddir); 1031 1032 complete_buffers(cmd->rq->bio, ok); 1033 1034 add_disk_randomness(cmd->rq->rq_disk); 1035 1036 DBGPX(printk("Done with %p\n", cmd->rq);); 1037 end_that_request_last(cmd->rq, ok ? 1 : -EIO); 1038} 1039 1040/* 1041 * The controller will interrupt us upon completion of commands. 1042 * Find the command on the completion queue, remove it, tell the OS and 1043 * try to queue up more IO 1044 */ 1045static irqreturn_t do_ida_intr(int irq, void *dev_id) 1046{ 1047 ctlr_info_t *h = dev_id; 1048 cmdlist_t *c; 1049 unsigned long istat; 1050 unsigned long flags; 1051 __u32 a,a1; 1052 1053 istat = h->access.intr_pending(h); 1054 /* Is this interrupt for us? */ 1055 if (istat == 0) 1056 return IRQ_NONE; 1057 1058 /* 1059 * If there are completed commands in the completion queue, 1060 * we had better do something about it. 1061 */ 1062 spin_lock_irqsave(IDA_LOCK(h->ctlr), flags); 1063 if (istat & FIFO_NOT_EMPTY) { 1064 while((a = h->access.command_completed(h))) { 1065 a1 = a; a &= ~3; 1066 if ((c = h->cmpQ) == NULL) 1067 { 1068 printk(KERN_WARNING "cpqarray: Completion of %08lx ignored\n", (unsigned long)a1); 1069 continue; 1070 } 1071 while(c->busaddr != a) { 1072 c = c->next; 1073 if (c == h->cmpQ) 1074 break; 1075 } 1076 /* 1077 * If we've found the command, take it off the 1078 * completion Q and free it 1079 */ 1080 if (c->busaddr == a) { 1081 removeQ(&h->cmpQ, c); 1082 /* Check for invalid command. 1083 * Controller returns command error, 1084 * But rcode = 0. 1085 */ 1086 1087 if((a1 & 0x03) && (c->req.hdr.rcode == 0)) 1088 { 1089 c->req.hdr.rcode = RCODE_INVREQ; 1090 } 1091 if (c->type == CMD_RWREQ) { 1092 complete_command(c, 0); 1093 cmd_free(h, c, 1); 1094 } else if (c->type == CMD_IOCTL_PEND) { 1095 c->type = CMD_IOCTL_DONE; 1096 } 1097 continue; 1098 } 1099 } 1100 } 1101 1102 /* 1103 * See if we can queue up some more IO 1104 */ 1105 do_ida_request(h->queue); 1106 spin_unlock_irqrestore(IDA_LOCK(h->ctlr), flags); 1107 return IRQ_HANDLED; 1108} 1109 1110/* 1111 * This timer was for timing out requests that haven't happened after 1112 * IDA_TIMEOUT. That wasn't such a good idea. This timer is used to 1113 * reset a flags structure so we don't flood the user with 1114 * "Non-Fatal error" messages. 1115 */ 1116static void ida_timer(unsigned long tdata) 1117{ 1118 ctlr_info_t *h = (ctlr_info_t*)tdata; 1119 1120 h->timer.expires = jiffies + IDA_TIMER; 1121 add_timer(&h->timer); 1122 h->misc_tflags = 0; 1123} 1124 1125static int ida_getgeo(struct block_device *bdev, struct hd_geometry *geo) 1126{ 1127 drv_info_t *drv = get_drv(bdev->bd_disk); 1128 1129 if (drv->cylinders) { 1130 geo->heads = drv->heads; 1131 geo->sectors = drv->sectors; 1132 geo->cylinders = drv->cylinders; 1133 } else { 1134 geo->heads = 0xff; 1135 geo->sectors = 0x3f; 1136 geo->cylinders = drv->nr_blks / (0xff*0x3f); 1137 } 1138 1139 return 0; 1140} 1141 1142/* 1143 * ida_ioctl does some miscellaneous stuff like reporting drive geometry, 1144 * setting readahead and submitting commands from userspace to the controller. 1145 */ 1146static int ida_ioctl(struct inode *inode, struct file *filep, unsigned int cmd, unsigned long arg) 1147{ 1148 drv_info_t *drv = get_drv(inode->i_bdev->bd_disk); 1149 ctlr_info_t *host = get_host(inode->i_bdev->bd_disk); 1150 int error; 1151 ida_ioctl_t __user *io = (ida_ioctl_t __user *)arg; 1152 ida_ioctl_t *my_io; 1153 1154 switch(cmd) { 1155 case IDAGETDRVINFO: 1156 if (copy_to_user(&io->c.drv, drv, sizeof(drv_info_t))) 1157 return -EFAULT; 1158 return 0; 1159 case IDAPASSTHRU: 1160 if (!capable(CAP_SYS_RAWIO)) 1161 return -EPERM; 1162 my_io = kmalloc(sizeof(ida_ioctl_t), GFP_KERNEL); 1163 if (!my_io) 1164 return -ENOMEM; 1165 error = -EFAULT; 1166 if (copy_from_user(my_io, io, sizeof(*my_io))) 1167 goto out_passthru; 1168 error = ida_ctlr_ioctl(host, drv - host->drv, my_io); 1169 if (error) 1170 goto out_passthru; 1171 error = -EFAULT; 1172 if (copy_to_user(io, my_io, sizeof(*my_io))) 1173 goto out_passthru; 1174 error = 0; 1175out_passthru: 1176 kfree(my_io); 1177 return error; 1178 case IDAGETCTLRSIG: 1179 if (!arg) return -EINVAL; 1180 put_user(host->ctlr_sig, (int __user *)arg); 1181 return 0; 1182 case IDAREVALIDATEVOLS: 1183 if (iminor(inode) != 0) 1184 return -ENXIO; 1185 return revalidate_allvol(host); 1186 case IDADRIVERVERSION: 1187 if (!arg) return -EINVAL; 1188 put_user(DRIVER_VERSION, (unsigned long __user *)arg); 1189 return 0; 1190 case IDAGETPCIINFO: 1191 { 1192 1193 ida_pci_info_struct pciinfo; 1194 1195 if (!arg) return -EINVAL; 1196 pciinfo.bus = host->pci_dev->bus->number; 1197 pciinfo.dev_fn = host->pci_dev->devfn; 1198 pciinfo.board_id = host->board_id; 1199 if(copy_to_user((void __user *) arg, &pciinfo, 1200 sizeof( ida_pci_info_struct))) 1201 return -EFAULT; 1202 return(0); 1203 } 1204 1205 default: 1206 return -EINVAL; 1207 } 1208 1209} 1210/* 1211 * ida_ctlr_ioctl is for passing commands to the controller from userspace. 1212 * The command block (io) has already been copied to kernel space for us, 1213 * however, any elements in the sglist need to be copied to kernel space 1214 * or copied back to userspace. 1215 * 1216 * Only root may perform a controller passthru command, however I'm not doing 1217 * any serious sanity checking on the arguments. Doing an IDA_WRITE_MEDIA and 1218 * putting a 64M buffer in the sglist is probably a *bad* idea. 1219 */ 1220static int ida_ctlr_ioctl(ctlr_info_t *h, int dsk, ida_ioctl_t *io) 1221{ 1222 int ctlr = h->ctlr; 1223 cmdlist_t *c; 1224 void *p = NULL; 1225 unsigned long flags; 1226 int error; 1227 1228 if ((c = cmd_alloc(h, 0)) == NULL) 1229 return -ENOMEM; 1230 c->ctlr = ctlr; 1231 c->hdr.unit = (io->unit & UNITVALID) ? (io->unit & ~UNITVALID) : dsk; 1232 c->hdr.size = sizeof(rblk_t) >> 2; 1233 c->size += sizeof(rblk_t); 1234 1235 c->req.hdr.cmd = io->cmd; 1236 c->req.hdr.blk = io->blk; 1237 c->req.hdr.blk_cnt = io->blk_cnt; 1238 c->type = CMD_IOCTL_PEND; 1239 1240 /* Pre submit processing */ 1241 switch(io->cmd) { 1242 case PASSTHRU_A: 1243 p = kmalloc(io->sg[0].size, GFP_KERNEL); 1244 if (!p) 1245 { 1246 error = -ENOMEM; 1247 cmd_free(h, c, 0); 1248 return(error); 1249 } 1250 if (copy_from_user(p, io->sg[0].addr, io->sg[0].size)) { 1251 kfree(p); 1252 cmd_free(h, c, 0); 1253 return -EFAULT; 1254 } 1255 c->req.hdr.blk = pci_map_single(h->pci_dev, &(io->c), 1256 sizeof(ida_ioctl_t), 1257 PCI_DMA_BIDIRECTIONAL); 1258 c->req.sg[0].size = io->sg[0].size; 1259 c->req.sg[0].addr = pci_map_single(h->pci_dev, p, 1260 c->req.sg[0].size, PCI_DMA_BIDIRECTIONAL); 1261 c->req.hdr.sg_cnt = 1; 1262 break; 1263 case IDA_READ: 1264 case READ_FLASH_ROM: 1265 case SENSE_CONTROLLER_PERFORMANCE: 1266 p = kmalloc(io->sg[0].size, GFP_KERNEL); 1267 if (!p) 1268 { 1269 error = -ENOMEM; 1270 cmd_free(h, c, 0); 1271 return(error); 1272 } 1273 1274 c->req.sg[0].size = io->sg[0].size; 1275 c->req.sg[0].addr = pci_map_single(h->pci_dev, p, 1276 c->req.sg[0].size, PCI_DMA_BIDIRECTIONAL); 1277 c->req.hdr.sg_cnt = 1; 1278 break; 1279 case IDA_WRITE: 1280 case IDA_WRITE_MEDIA: 1281 case DIAG_PASS_THRU: 1282 case COLLECT_BUFFER: 1283 case WRITE_FLASH_ROM: 1284 p = kmalloc(io->sg[0].size, GFP_KERNEL); 1285 if (!p) 1286 { 1287 error = -ENOMEM; 1288 cmd_free(h, c, 0); 1289 return(error); 1290 } 1291 if (copy_from_user(p, io->sg[0].addr, io->sg[0].size)) { 1292 kfree(p); 1293 cmd_free(h, c, 0); 1294 return -EFAULT; 1295 } 1296 c->req.sg[0].size = io->sg[0].size; 1297 c->req.sg[0].addr = pci_map_single(h->pci_dev, p, 1298 c->req.sg[0].size, PCI_DMA_BIDIRECTIONAL); 1299 c->req.hdr.sg_cnt = 1; 1300 break; 1301 default: 1302 c->req.sg[0].size = sizeof(io->c); 1303 c->req.sg[0].addr = pci_map_single(h->pci_dev,&io->c, 1304 c->req.sg[0].size, PCI_DMA_BIDIRECTIONAL); 1305 c->req.hdr.sg_cnt = 1; 1306 } 1307 1308 /* Put the request on the tail of the request queue */ 1309 spin_lock_irqsave(IDA_LOCK(ctlr), flags); 1310 addQ(&h->reqQ, c); 1311 h->Qdepth++; 1312 start_io(h); 1313 spin_unlock_irqrestore(IDA_LOCK(ctlr), flags); 1314 1315 /* Wait for completion */ 1316 while(c->type != CMD_IOCTL_DONE) 1317 schedule(); 1318 1319 /* Unmap the DMA */ 1320 pci_unmap_single(h->pci_dev, c->req.sg[0].addr, c->req.sg[0].size, 1321 PCI_DMA_BIDIRECTIONAL); 1322 /* Post submit processing */ 1323 switch(io->cmd) { 1324 case PASSTHRU_A: 1325 pci_unmap_single(h->pci_dev, c->req.hdr.blk, 1326 sizeof(ida_ioctl_t), 1327 PCI_DMA_BIDIRECTIONAL); 1328 case IDA_READ: 1329 case DIAG_PASS_THRU: 1330 case SENSE_CONTROLLER_PERFORMANCE: 1331 case READ_FLASH_ROM: 1332 if (copy_to_user(io->sg[0].addr, p, io->sg[0].size)) { 1333 kfree(p); 1334 return -EFAULT; 1335 } 1336 /* fall through and free p */ 1337 case IDA_WRITE: 1338 case IDA_WRITE_MEDIA: 1339 case COLLECT_BUFFER: 1340 case WRITE_FLASH_ROM: 1341 kfree(p); 1342 break; 1343 default:; 1344 /* Nothing to do */ 1345 } 1346 1347 io->rcode = c->req.hdr.rcode; 1348 cmd_free(h, c, 0); 1349 return(0); 1350} 1351 1352/* 1353 * Commands are pre-allocated in a large block. Here we use a simple bitmap 1354 * scheme to suballocte them to the driver. Operations that are not time 1355 * critical (and can wait for kmalloc and possibly sleep) can pass in NULL 1356 * as the first argument to get a new command. 1357 */ 1358static cmdlist_t * cmd_alloc(ctlr_info_t *h, int get_from_pool) 1359{ 1360 cmdlist_t * c; 1361 int i; 1362 dma_addr_t cmd_dhandle; 1363 1364 if (!get_from_pool) { 1365 c = (cmdlist_t*)pci_alloc_consistent(h->pci_dev, 1366 sizeof(cmdlist_t), &cmd_dhandle); 1367 if(c==NULL) 1368 return NULL; 1369 } else { 1370 do { 1371 i = find_first_zero_bit(h->cmd_pool_bits, NR_CMDS); 1372 if (i == NR_CMDS) 1373 return NULL; 1374 } while(test_and_set_bit(i&(BITS_PER_LONG-1), h->cmd_pool_bits+(i/BITS_PER_LONG)) != 0); 1375 c = h->cmd_pool + i; 1376 cmd_dhandle = h->cmd_pool_dhandle + i*sizeof(cmdlist_t); 1377 h->nr_allocs++; 1378 } 1379 1380 memset(c, 0, sizeof(cmdlist_t)); 1381 c->busaddr = cmd_dhandle; 1382 return c; 1383} 1384 1385static void cmd_free(ctlr_info_t *h, cmdlist_t *c, int got_from_pool) 1386{ 1387 int i; 1388 1389 if (!got_from_pool) { 1390 pci_free_consistent(h->pci_dev, sizeof(cmdlist_t), c, 1391 c->busaddr); 1392 } else { 1393 i = c - h->cmd_pool; 1394 clear_bit(i&(BITS_PER_LONG-1), h->cmd_pool_bits+(i/BITS_PER_LONG)); 1395 h->nr_frees++; 1396 } 1397} 1398 1399/*********************************************************************** 1400 name: sendcmd 1401 Send a command to an IDA using the memory mapped FIFO interface 1402 and wait for it to complete. 1403 This routine should only be called at init time. 1404***********************************************************************/ 1405static int sendcmd( 1406 __u8 cmd, 1407 int ctlr, 1408 void *buff, 1409 size_t size, 1410 unsigned int blk, 1411 unsigned int blkcnt, 1412 unsigned int log_unit ) 1413{ 1414 cmdlist_t *c; 1415 int complete; 1416 unsigned long temp; 1417 unsigned long i; 1418 ctlr_info_t *info_p = hba[ctlr]; 1419 1420 c = cmd_alloc(info_p, 1); 1421 if(!c) 1422 return IO_ERROR; 1423 c->ctlr = ctlr; 1424 c->hdr.unit = log_unit; 1425 c->hdr.prio = 0; 1426 c->hdr.size = sizeof(rblk_t) >> 2; 1427 c->size += sizeof(rblk_t); 1428 1429 /* The request information. */ 1430 c->req.hdr.next = 0; 1431 c->req.hdr.rcode = 0; 1432 c->req.bp = 0; 1433 c->req.hdr.sg_cnt = 1; 1434 c->req.hdr.reserved = 0; 1435 1436 if (size == 0) 1437 c->req.sg[0].size = 512; 1438 else 1439 c->req.sg[0].size = size; 1440 1441 c->req.hdr.blk = blk; 1442 c->req.hdr.blk_cnt = blkcnt; 1443 c->req.hdr.cmd = (unsigned char) cmd; 1444 c->req.sg[0].addr = (__u32) pci_map_single(info_p->pci_dev, 1445 buff, c->req.sg[0].size, PCI_DMA_BIDIRECTIONAL); 1446 /* 1447 * Disable interrupt 1448 */ 1449 info_p->access.set_intr_mask(info_p, 0); 1450 /* Make sure there is room in the command FIFO */ 1451 /* Actually it should be completely empty at this time. */ 1452 for (i = 200000; i > 0; i--) { 1453 temp = info_p->access.fifo_full(info_p); 1454 if (temp != 0) { 1455 break; 1456 } 1457 udelay(10); 1458DBG( 1459 printk(KERN_WARNING "cpqarray ida%d: idaSendPciCmd FIFO full," 1460 " waiting!\n", ctlr); 1461); 1462 } 1463 /* 1464 * Send the cmd 1465 */ 1466 info_p->access.submit_command(info_p, c); 1467 complete = pollcomplete(ctlr); 1468 1469 pci_unmap_single(info_p->pci_dev, (dma_addr_t) c->req.sg[0].addr, 1470 c->req.sg[0].size, PCI_DMA_BIDIRECTIONAL); 1471 if (complete != 1) { 1472 if (complete != c->busaddr) { 1473 printk( KERN_WARNING 1474 "cpqarray ida%d: idaSendPciCmd " 1475 "Invalid command list address returned! (%08lx)\n", 1476 ctlr, (unsigned long)complete); 1477 cmd_free(info_p, c, 1); 1478 return (IO_ERROR); 1479 } 1480 } else { 1481 printk( KERN_WARNING 1482 "cpqarray ida%d: idaSendPciCmd Timeout out, " 1483 "No command list address returned!\n", 1484 ctlr); 1485 cmd_free(info_p, c, 1); 1486 return (IO_ERROR); 1487 } 1488 1489 if (c->req.hdr.rcode & 0x00FE) { 1490 if (!(c->req.hdr.rcode & BIG_PROBLEM)) { 1491 printk( KERN_WARNING 1492 "cpqarray ida%d: idaSendPciCmd, error: " 1493 "Controller failed at init time " 1494 "cmd: 0x%x, return code = 0x%x\n", 1495 ctlr, c->req.hdr.cmd, c->req.hdr.rcode); 1496 1497 cmd_free(info_p, c, 1); 1498 return (IO_ERROR); 1499 } 1500 } 1501 cmd_free(info_p, c, 1); 1502 return (IO_OK); 1503} 1504 1505/* 1506 * revalidate_allvol is for online array config utilities. After a 1507 * utility reconfigures the drives in the array, it can use this function 1508 * (through an ioctl) to make the driver zap any previous disk structs for 1509 * that controller and get new ones. 1510 * 1511 * Right now I'm using the getgeometry() function to do this, but this 1512 * function should probably be finer grained and allow you to revalidate one 1513 * particualar logical volume (instead of all of them on a particular 1514 * controller). 1515 */ 1516static int revalidate_allvol(ctlr_info_t *host) 1517{ 1518 int ctlr = host->ctlr; 1519 int i; 1520 unsigned long flags; 1521 1522 spin_lock_irqsave(IDA_LOCK(ctlr), flags); 1523 if (host->usage_count > 1) { 1524 spin_unlock_irqrestore(IDA_LOCK(ctlr), flags); 1525 printk(KERN_WARNING "cpqarray: Device busy for volume" 1526 " revalidation (usage=%d)\n", host->usage_count); 1527 return -EBUSY; 1528 } 1529 host->usage_count++; 1530 spin_unlock_irqrestore(IDA_LOCK(ctlr), flags); 1531 1532 /* 1533 * Set the partition and block size structures for all volumes 1534 * on this controller to zero. We will reread all of this data 1535 */ 1536 set_capacity(ida_gendisk[ctlr][0], 0); 1537 for (i = 1; i < NWD; i++) { 1538 struct gendisk *disk = ida_gendisk[ctlr][i]; 1539 if (disk->flags & GENHD_FL_UP) 1540 del_gendisk(disk); 1541 } 1542 memset(host->drv, 0, sizeof(drv_info_t)*NWD); 1543 1544 /* 1545 * Tell the array controller not to give us any interrupts while 1546 * we check the new geometry. Then turn interrupts back on when 1547 * we're done. 1548 */ 1549 host->access.set_intr_mask(host, 0); 1550 getgeometry(ctlr); 1551 host->access.set_intr_mask(host, FIFO_NOT_EMPTY); 1552 1553 for(i=0; i<NWD; i++) { 1554 struct gendisk *disk = ida_gendisk[ctlr][i]; 1555 drv_info_t *drv = &host->drv[i]; 1556 if (i && !drv->nr_blks) 1557 continue; 1558 blk_queue_hardsect_size(host->queue, drv->blk_size); 1559 set_capacity(disk, drv->nr_blks); 1560 disk->queue = host->queue; 1561 disk->private_data = drv; 1562 if (i) 1563 add_disk(disk); 1564 } 1565 1566 host->usage_count--; 1567 return 0; 1568} 1569 1570static int ida_revalidate(struct gendisk *disk) 1571{ 1572 drv_info_t *drv = disk->private_data; 1573 set_capacity(disk, drv->nr_blks); 1574 return 0; 1575} 1576 1577/******************************************************************** 1578 name: pollcomplete 1579 Wait polling for a command to complete. 1580 The memory mapped FIFO is polled for the completion. 1581 Used only at init time, interrupts disabled. 1582 ********************************************************************/ 1583static int pollcomplete(int ctlr) 1584{ 1585 int done; 1586 int i; 1587 1588 /* Wait (up to 2 seconds) for a command to complete */ 1589 1590 for (i = 200000; i > 0; i--) { 1591 done = hba[ctlr]->access.command_completed(hba[ctlr]); 1592 if (done == 0) { 1593 udelay(10); /* a short fixed delay */ 1594 } else 1595 return (done); 1596 } 1597 /* Invalid address to tell caller we ran out of time */ 1598 return 1; 1599} 1600/***************************************************************** 1601 start_fwbk 1602 Starts controller firmwares background processing. 1603 Currently only the Integrated Raid controller needs this done. 1604 If the PCI mem address registers are written to after this, 1605 data corruption may occur 1606*****************************************************************/ 1607static void start_fwbk(int ctlr) 1608{ 1609 id_ctlr_t *id_ctlr_buf; 1610 int ret_code; 1611 1612 if( (hba[ctlr]->board_id != 0x40400E11) 1613 && (hba[ctlr]->board_id != 0x40480E11) ) 1614 1615 /* Not a Integrated Raid, so there is nothing for us to do */ 1616 return; 1617 printk(KERN_DEBUG "cpqarray: Starting firmware's background" 1618 " processing\n"); 1619 /* Command does not return anything, but idasend command needs a 1620 buffer */ 1621 id_ctlr_buf = (id_ctlr_t *)kmalloc(sizeof(id_ctlr_t), GFP_KERNEL); 1622 if(id_ctlr_buf==NULL) 1623 { 1624 printk(KERN_WARNING "cpqarray: Out of memory. " 1625 "Unable to start background processing.\n"); 1626 return; 1627 } 1628 ret_code = sendcmd(RESUME_BACKGROUND_ACTIVITY, ctlr, 1629 id_ctlr_buf, 0, 0, 0, 0); 1630 if(ret_code != IO_OK) 1631 printk(KERN_WARNING "cpqarray: Unable to start" 1632 " background processing\n"); 1633 1634 kfree(id_ctlr_buf); 1635} 1636/***************************************************************** 1637 getgeometry 1638 Get ida logical volume geometry from the controller 1639 This is a large bit of code which once existed in two flavors, 1640 It is used only at init time. 1641*****************************************************************/ 1642static void getgeometry(int ctlr) 1643{ 1644 id_log_drv_t *id_ldrive; 1645 id_ctlr_t *id_ctlr_buf; 1646 sense_log_drv_stat_t *id_lstatus_buf; 1647 config_t *sense_config_buf; 1648 unsigned int log_unit, log_index; 1649 int ret_code, size; 1650 drv_info_t *drv; 1651 ctlr_info_t *info_p = hba[ctlr]; 1652 int i; 1653 1654 info_p->log_drv_map = 0; 1655 1656 id_ldrive = (id_log_drv_t *)kmalloc(sizeof(id_log_drv_t), GFP_KERNEL); 1657 if(id_ldrive == NULL) 1658 { 1659 printk( KERN_ERR "cpqarray: out of memory.\n"); 1660 return; 1661 } 1662 1663 id_ctlr_buf = (id_ctlr_t *)kmalloc(sizeof(id_ctlr_t), GFP_KERNEL); 1664 if(id_ctlr_buf == NULL) 1665 { 1666 kfree(id_ldrive); 1667 printk( KERN_ERR "cpqarray: out of memory.\n"); 1668 return; 1669 } 1670 1671 id_lstatus_buf = (sense_log_drv_stat_t *)kmalloc(sizeof(sense_log_drv_stat_t), GFP_KERNEL); 1672 if(id_lstatus_buf == NULL) 1673 { 1674 kfree(id_ctlr_buf); 1675 kfree(id_ldrive); 1676 printk( KERN_ERR "cpqarray: out of memory.\n"); 1677 return; 1678 } 1679 1680 sense_config_buf = (config_t *)kmalloc(sizeof(config_t), GFP_KERNEL); 1681 if(sense_config_buf == NULL) 1682 { 1683 kfree(id_lstatus_buf); 1684 kfree(id_ctlr_buf); 1685 kfree(id_ldrive); 1686 printk( KERN_ERR "cpqarray: out of memory.\n"); 1687 return; 1688 } 1689 1690 memset(id_ldrive, 0, sizeof(id_log_drv_t)); 1691 memset(id_ctlr_buf, 0, sizeof(id_ctlr_t)); 1692 memset(id_lstatus_buf, 0, sizeof(sense_log_drv_stat_t)); 1693 memset(sense_config_buf, 0, sizeof(config_t)); 1694 1695 info_p->phys_drives = 0; 1696 info_p->log_drv_map = 0; 1697 info_p->drv_assign_map = 0; 1698 info_p->drv_spare_map = 0; 1699 info_p->mp_failed_drv_map = 0; /* only initialized here */ 1700 /* Get controllers info for this logical drive */ 1701 ret_code = sendcmd(ID_CTLR, ctlr, id_ctlr_buf, 0, 0, 0, 0); 1702 if (ret_code == IO_ERROR) { 1703 /* 1704 * If can't get controller info, set the logical drive map to 0, 1705 * so the idastubopen will fail on all logical drives 1706 * on the controller. 1707 */ 1708 /* Free all the buffers and return */ 1709 printk(KERN_ERR "cpqarray: error sending ID controller\n"); 1710 kfree(sense_config_buf); 1711 kfree(id_lstatus_buf); 1712 kfree(id_ctlr_buf); 1713 kfree(id_ldrive); 1714 return; 1715 } 1716 1717 info_p->log_drives = id_ctlr_buf->nr_drvs; 1718 for(i=0;i<4;i++) 1719 info_p->firm_rev[i] = id_ctlr_buf->firm_rev[i]; 1720 info_p->ctlr_sig = id_ctlr_buf->cfg_sig; 1721 1722 printk(" (%s)\n", info_p->product_name); 1723 /* 1724 * Initialize logical drive map to zero 1725 */ 1726 log_index = 0; 1727 /* 1728 * Get drive geometry for all logical drives 1729 */ 1730 if (id_ctlr_buf->nr_drvs > 16) 1731 printk(KERN_WARNING "cpqarray ida%d: This driver supports " 1732 "16 logical drives per controller.\n. " 1733 " Additional drives will not be " 1734 "detected\n", ctlr); 1735 1736 for (log_unit = 0; 1737 (log_index < id_ctlr_buf->nr_drvs) 1738 && (log_unit < NWD); 1739 log_unit++) { 1740 size = sizeof(sense_log_drv_stat_t); 1741 1742 /* 1743 Send "Identify logical drive status" cmd 1744 */ 1745 ret_code = sendcmd(SENSE_LOG_DRV_STAT, 1746 ctlr, id_lstatus_buf, size, 0, 0, log_unit); 1747 if (ret_code == IO_ERROR) { 1748 /* 1749 If can't get logical drive status, set 1750 the logical drive map to 0, so the 1751 idastubopen will fail for all logical drives 1752 on the controller. 1753 */ 1754 info_p->log_drv_map = 0; 1755 printk( KERN_WARNING 1756 "cpqarray ida%d: idaGetGeometry - Controller" 1757 " failed to report status of logical drive %d\n" 1758 "Access to this controller has been disabled\n", 1759 ctlr, log_unit); 1760 /* Free all the buffers and return */ 1761 kfree(sense_config_buf); 1762 kfree(id_lstatus_buf); 1763 kfree(id_ctlr_buf); 1764 kfree(id_ldrive); 1765 return; 1766 } 1767 /* 1768 Make sure the logical drive is configured 1769 */ 1770 if (id_lstatus_buf->status != LOG_NOT_CONF) { 1771 ret_code = sendcmd(ID_LOG_DRV, ctlr, id_ldrive, 1772 sizeof(id_log_drv_t), 0, 0, log_unit); 1773 /* 1774 If error, the bit for this 1775 logical drive won't be set and 1776 idastubopen will return error. 1777 */ 1778 if (ret_code != IO_ERROR) { 1779 drv = &info_p->drv[log_unit]; 1780 drv->blk_size = id_ldrive->blk_size; 1781 drv->nr_blks = id_ldrive->nr_blks; 1782 drv->cylinders = id_ldrive->drv.cyl; 1783 drv->heads = id_ldrive->drv.heads; 1784 drv->sectors = id_ldrive->drv.sect_per_track; 1785 info_p->log_drv_map |= (1 << log_unit); 1786 1787 printk(KERN_INFO "cpqarray ida/c%dd%d: blksz=%d nr_blks=%d\n", 1788 ctlr, log_unit, drv->blk_size, drv->nr_blks); 1789 ret_code = sendcmd(SENSE_CONFIG, 1790 ctlr, sense_config_buf, 1791 sizeof(config_t), 0, 0, log_unit); 1792 if (ret_code == IO_ERROR) { 1793 info_p->log_drv_map = 0; 1794 /* Free all the buffers and return */ 1795 printk(KERN_ERR "cpqarray: error sending sense config\n"); 1796 kfree(sense_config_buf); 1797 kfree(id_lstatus_buf); 1798 kfree(id_ctlr_buf); 1799 kfree(id_ldrive); 1800 return; 1801 1802 } 1803 1804 info_p->phys_drives = 1805 sense_config_buf->ctlr_phys_drv; 1806 info_p->drv_assign_map 1807 |= sense_config_buf->drv_asgn_map; 1808 info_p->drv_assign_map 1809 |= sense_config_buf->spare_asgn_map; 1810 info_p->drv_spare_map 1811 |= sense_config_buf->spare_asgn_map; 1812 } /* end of if no error on id_ldrive */ 1813 log_index = log_index + 1; 1814 } /* end of if logical drive configured */ 1815 } /* end of for log_unit */ 1816 kfree(sense_config_buf); 1817 kfree(id_ldrive); 1818 kfree(id_lstatus_buf); 1819 kfree(id_ctlr_buf); 1820 return; 1821 1822} 1823 1824static void __exit cpqarray_exit(void) 1825{ 1826 int i; 1827 1828 pci_unregister_driver(&cpqarray_pci_driver); 1829 1830 /* Double check that all controller entries have been removed */ 1831 for(i=0; i<MAX_CTLR; i++) { 1832 if (hba[i] != NULL) { 1833 printk(KERN_WARNING "cpqarray: Removing EISA " 1834 "controller %d\n", i); 1835 cpqarray_remove_one_eisa(i); 1836 } 1837 } 1838 1839 remove_proc_entry("cpqarray", proc_root_driver); 1840} 1841 1842module_init(cpqarray_init) 1843module_exit(cpqarray_exit)