开通博客赚积分
发布资源赚积分
分类

源码开发语言/平台
当前位置：首页 > 源码/资料 > Linux/Unix编程 > 查看源码
cciss.c
资源名称：linux-2.4.20.tar.gz　[点击查看]
上传用户：jlfgdled
上传日期：2013-04-10
资源大小：33168k
文件大小：63k
源码类别：

Linux/Unix编程

开发平台：

Unix_Linux

cciss.c：源码内容
  1. /*
  2.  *    Disk Array driver for Compaq SMART2 Controllers
  3.  *    Copyright 2000 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 arrays@compaq.com
  20.  *
  21.  */
  23. #include <linux/config.h> /* CONFIG_PROC_FS */
  24. #include <linux/module.h>
  25. #include <linux/version.h>
  26. #include <linux/types.h>
  27. #include <linux/pci.h>
  28. #include <linux/kernel.h>
  29. #include <linux/slab.h>
  30. #include <linux/delay.h>
  31. #include <linux/major.h>
  32. #include <linux/fs.h>
  33. #include <linux/blkpg.h>
  34. #include <linux/timer.h>
  35. #include <linux/proc_fs.h>
  36. #include <linux/init.h> 
  37. #include <linux/hdreg.h>
  38. #include <linux/spinlock.h>
  39. #include <asm/uaccess.h>
  40. #include <asm/io.h>
  42. #include <linux/blk.h>
  43. #include <linux/blkdev.h>
  44. #include <linux/genhd.h>
  46. #define CCISS_DRIVER_VERSION(maj,min,submin) ((maj<<16)|(min<<8)|(submin))
  47. #define DRIVER_NAME "Compaq CISS Driver (v 2.4.5)"
  48. #define DRIVER_VERSION CCISS_DRIVER_VERSION(2,4,5)
  50. /* Embedded module documentation macros - see modules.h */
  51. MODULE_AUTHOR("Charles M. White III - Compaq Computer Corporation");
  52. MODULE_DESCRIPTION("Driver for Compaq Smart Array Controller 5300");
  53. MODULE_LICENSE("GPL");
  55. #include "cciss_cmd.h"
  56. #include "cciss.h"
  57. #include <linux/cciss_ioctl.h>
  59. /* define the PCI info for the cards we can control */
  60. const struct pci_device_id cciss_pci_device_id[] = {
  61. { PCI_VENDOR_ID_COMPAQ, PCI_DEVICE_ID_COMPAQ_CISS,
  62. 0x0E11, 0x4070, 0, 0, 0},
  63. { PCI_VENDOR_ID_COMPAQ, PCI_DEVICE_ID_COMPAQ_CISSB,
  64.                         0x0E11, 0x4080, 0, 0, 0},
  65. { PCI_VENDOR_ID_COMPAQ, PCI_DEVICE_ID_COMPAQ_CISSB,
  66.                         0x0E11, 0x4082, 0, 0, 0},
  67. { PCI_VENDOR_ID_COMPAQ, PCI_DEVICE_ID_COMPAQ_CISSB,
  68.                         0x0E11, 0x4083, 0, 0, 0},
  69. {0,}
  70. };
  71. MODULE_DEVICE_TABLE(pci, cciss_pci_device_id);
  73. #define NR_PRODUCTS (sizeof(products)/sizeof(struct board_type))
  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.  */
  79. static struct board_type products[] = {
  80. { 0x40700E11, "Smart Array 5300", &SA5_access },
  81. { 0x40800E11, "Smart Array 5i", &SA5B_access},
  82. { 0x40820E11, "Smart Array 532", &SA5B_access},
  83. { 0x40830E11, "Smart Array 5312", &SA5B_access},
  84. };
  86. /* How long to wait (in millesconds) for board to go into simple mode */
  87. #define MAX_CONFIG_WAIT 1000 
  89. #define READ_AHEAD   128
  90. #define NR_CMDS  128 /* #commands that can be outstanding */
  91. #define MAX_CTLR 8
  93. #define CCISS_DMA_MASK 0xFFFFFFFF /* 32 bit DMA */
  95. static ctlr_info_t *hba[MAX_CTLR];
  97. static struct proc_dir_entry *proc_cciss;
  99. static void do_cciss_request(request_queue_t *q);
  100. static int cciss_open(struct inode *inode, struct file *filep);
  101. static int cciss_release(struct inode *inode, struct file *filep);
  102. static int cciss_ioctl(struct inode *inode, struct file *filep, 
  103. unsigned int cmd, unsigned long arg);
  105. static int revalidate_logvol(kdev_t dev, int maxusage);
  106. static int frevalidate_logvol(kdev_t dev);
  108. static void cciss_getgeometry(int cntl_num);
  110. static inline void addQ(CommandList_struct **Qptr, CommandList_struct *c);
  111. static void start_io( ctlr_info_t *h);
  113. #ifdef CONFIG_PROC_FS
  114. static int cciss_proc_get_info(char *buffer, char **start, off_t offset, 
  115. int length, int *eof, void *data);
  116. static void cciss_procinit(int i);
  117. #else
  118. static int cciss_proc_get_info(char *buffer, char **start, off_t offset, 
  119. int length, int *eof, void *data) { return 0;}
  120. static void cciss_procinit(int i) {}
  121. #endif /* CONFIG_PROC_FS */
  123. static struct block_device_operations cciss_fops  = {
  124. owner: THIS_MODULE,
  125. open: cciss_open, 
  126. release:         cciss_release,
  127.         ioctl: cciss_ioctl,
  128. revalidate: frevalidate_logvol,
  129. };
  131. #include "cciss_scsi.c" /* For SCSI tape support */
  133. /*
  134.  * Report information about this controller.
  135.  */
  136. #ifdef CONFIG_PROC_FS
  137. static int cciss_proc_get_info(char *buffer, char **start, off_t offset, 
  138. int length, int *eof, void *data)
  139. {
  140.         off_t pos = 0;
  141.         off_t len = 0;
  142.         int size, i, ctlr;
  143.         ctlr_info_t *h = (ctlr_info_t*)data;
  144.         drive_info_struct *drv;
  146.         ctlr = h->ctlr;
  147.         size = sprintf(buffer, "%s:  Compaq %s Controllern"
  148.                 "       Board ID: 0x%08lxn"
  149. "       Firmware Version: %c%c%c%cn"
  150.                 "       Memory Address: 0x%08lxn"
  151.                 "       IRQ: %dn"
  152.                 "       Logical drives: %dn"
  153.                 "       Current Q depth: %dn"
  154. "       Current # commands on controller %dn"
  155.                 "       Max Q depth since init: %dn"
  156. "       Max # commands on controller since init: %dn"
  157. "       Max SG entries since init: %dnn",
  158.                 h->devname,
  159.                 h->product_name,
  160.                 (unsigned long)h->board_id,
  161. h->firm_ver[0], h->firm_ver[1], h->firm_ver[2], h->firm_ver[3],
  162.                 (unsigned long)h->vaddr,
  163.                 (unsigned int)h->intr,
  164.                 h->num_luns, 
  165.                 h->Qdepth, h->commands_outstanding,
  166. h->maxQsinceinit, h->max_outstanding, h->maxSG);
  168.         pos += size; len += size;
  169. cciss_proc_tape_report(ctlr, buffer, &pos, &len);
  170. for(i=0; i<h->num_luns; i++) {
  171.                 drv = &h->drv[i];
  172.                 size = sprintf(buffer+len, "cciss/c%dd%d: blksz=%d nr_blocks=%dn",
  173.                                 ctlr, i, drv->block_size, drv->nr_blocks);
  174.                 pos += size; len += size;
  175.         }
  177. size = sprintf(buffer+len, "nr_allocs = %dnnr_frees = %dn",
  178.                         h->nr_allocs, h->nr_frees);
  179.         pos += size; len += size;
  181.         *eof = 1;
  182.         *start = buffer+offset;
  183.         len -= offset;
  184.         if (len>length)
  185.                 len = length;
  186.         return len;
  187. }
  189. static int
  190. cciss_proc_write(struct file *file, const char *buffer,
  191. unsigned long count, void *data)
  192. {
  193. unsigned char cmd[80];
  194. int len;
  195. #ifdef CONFIG_CISS_SCSI_TAPE
  196. ctlr_info_t *h = (ctlr_info_t *) data;
  197. int rc;
  198. #endif
  200. if (count > sizeof(cmd)-1) return -EINVAL;
  201. if (copy_from_user(cmd, buffer, count)) return -EFAULT;
  202. cmd[count] = '';
  203. len = strlen(cmd); // safe???
  204. if (cmd[len-1] == 'n')
  205. cmd[--len] = '';
  206. # ifdef CONFIG_CISS_SCSI_TAPE
  207. if (strcmp("engage scsi", cmd)==0) {
  208. rc = cciss_engage_scsi(h->ctlr);
  209. if (rc != 0) return -rc;
  210. return count;
  211. }
  212. /* might be nice to have "disengage" too, but it's not
  213.    safely possible. (only 1 module use count, lock issues.) */
  214. # endif
  215. return -EINVAL;
  216. }
  218. /*
  219.  * Get us a file in /proc/cciss that says something about each controller.
  220.  * Create /proc/cciss if it doesn't exist yet.
  221.  */
  222. static void __init cciss_procinit(int i)
  223. {
  224. struct proc_dir_entry *pde;
  226. if (proc_cciss == NULL) {
  227. proc_cciss = proc_mkdir("cciss", proc_root_driver);
  228. if (!proc_cciss)
  229. return;
  230. }
  232. pde = create_proc_read_entry(hba[i]->devname,
  233. S_IWUSR | S_IRUSR | S_IRGRP | S_IROTH,
  234. proc_cciss, cciss_proc_get_info, hba[i]);
  235. pde->write_proc = cciss_proc_write;
  236. }
  237. #endif /* CONFIG_PROC_FS */
  239. /* 
  240.  * For operations that cannot sleep, a command block is allocated at init, 
  241.  * and managed by cmd_alloc() and cmd_free() using a simple bitmap to track
  242.  * which ones are free or in use.  For operations that can wait for kmalloc 
  243.  * to possible sleep, this routine can be called with get_from_pool set to 0. 
  244.  * cmd_free() MUST be called with a got_from_pool set to 0 if cmd_alloc was. 
  245.  */ 
  246. static CommandList_struct * cmd_alloc(ctlr_info_t *h, int get_from_pool)
  247. {
  248. CommandList_struct *c;
  249. int i; 
  250. u64bit temp64;
  251. dma_addr_t cmd_dma_handle, err_dma_handle;
  253. if (!get_from_pool)
  254. {
  255. c = (CommandList_struct *) pci_alloc_consistent(
  256. h->pdev, sizeof(CommandList_struct), &cmd_dma_handle); 
  257.          if(c==NULL)
  258.                   return NULL;
  259. memset(c, 0, sizeof(CommandList_struct));
  261. c->err_info = (ErrorInfo_struct *)pci_alloc_consistent(
  262. h->pdev, sizeof(ErrorInfo_struct), 
  263. &err_dma_handle);
  265. if (c->err_info == NULL)
  266. {
  267. pci_free_consistent(h->pdev, 
  268. sizeof(CommandList_struct), c, cmd_dma_handle);
  269. return NULL;
  270. }
  271. memset(c->err_info, 0, sizeof(ErrorInfo_struct));
  272. } else /* get it out of the controllers pool */ 
  273. {
  274.       do {
  275.                  i = find_first_zero_bit(h->cmd_pool_bits, NR_CMDS);
  276.                         if (i == NR_CMDS)
  277.                                 return NULL;
  278.                 } while(test_and_set_bit(i%32, h->cmd_pool_bits+(i/32)) != 0);
  279. #ifdef CCISS_DEBUG
  280. printk(KERN_DEBUG "cciss: using command buffer %dn", i);
  281. #endif
  282.                 c = h->cmd_pool + i;
  283. memset(c, 0, sizeof(CommandList_struct));
  284. cmd_dma_handle = h->cmd_pool_dhandle 
  285. + i*sizeof(CommandList_struct);
  286. c->err_info = h->errinfo_pool + i;
  287. memset(c->err_info, 0, sizeof(ErrorInfo_struct));
  288. err_dma_handle = h->errinfo_pool_dhandle 
  289. + i*sizeof(ErrorInfo_struct);
  290.                 h->nr_allocs++;
  291.         }
  293. c->busaddr = (__u32) cmd_dma_handle;
  294. temp64.val = (__u64) err_dma_handle;
  295. c->ErrDesc.Addr.lower = temp64.val32.lower;
  296. c->ErrDesc.Addr.upper = temp64.val32.upper;
  297. c->ErrDesc.Len = sizeof(ErrorInfo_struct);
  299. c->ctlr = h->ctlr;
  300.         return c;
  303. }
  305. /* 
  306.  * Frees a command block that was previously allocated with cmd_alloc(). 
  307.  */
  308. static void cmd_free(ctlr_info_t *h, CommandList_struct *c, int got_from_pool)
  309. {
  310. int i;
  311. u64bit temp64;
  313. if( !got_from_pool)
  314. { 
  315. temp64.val32.lower = c->ErrDesc.Addr.lower;
  316. temp64.val32.upper = c->ErrDesc.Addr.upper;
  317. pci_free_consistent(h->pdev, sizeof(ErrorInfo_struct), 
  318. c->err_info, (dma_addr_t) temp64.val);
  319. pci_free_consistent(h->pdev, sizeof(CommandList_struct), 
  320. c, (dma_addr_t) c->busaddr);
  321. } else 
  322. {
  323. i = c - h->cmd_pool;
  324. clear_bit(i%32, h->cmd_pool_bits+(i/32));
  325.                 h->nr_frees++;
  326.         }
  327. }
  329. /*  
  330.  * fills in the disk information. 
  331.  */
  332. static void cciss_geninit( int ctlr)
  333. {
  334. drive_info_struct *drv;
  335. int i,j;
  337. /* Loop through each real device */ 
  338. hba[ctlr]->gendisk.nr_real = 0; 
  339. for(i=0; i< NWD; i++)
  340. {
  341. drv = &(hba[ctlr]->drv[i]);
  342. if( !(drv->nr_blocks))
  343. continue;
  344. hba[ctlr]->hd[i << NWD_SHIFT].nr_sects = 
  345. hba[ctlr]->sizes[i << NWD_SHIFT] = drv->nr_blocks;
  347. /* for each partition */ 
  348. for(j=0; j<MAX_PART; j++)
  349. {
  350. hba[ctlr]->blocksizes[(i<<NWD_SHIFT) + j] = 1024; 
  352. hba[ctlr]->hardsizes[ (i<<NWD_SHIFT) + j] = 
  353. drv->block_size;
  354. }
  355. hba[ctlr]->gendisk.nr_real++;
  356. }
  357. }
  358. /*
  359.  * Open.  Make sure the device is really there.
  360.  */
  361. static int cciss_open(struct inode *inode, struct file *filep)
  362. {
  363. int ctlr = MAJOR(inode->i_rdev) - MAJOR_NR;
  364. int dsk  = MINOR(inode->i_rdev) >> NWD_SHIFT;
  366. #ifdef CCISS_DEBUG
  367. printk(KERN_DEBUG "cciss_open %x (%x:%x)n", inode->i_rdev, ctlr, dsk);
  368. #endif /* CCISS_DEBUG */ 
  370. if (ctlr > MAX_CTLR || hba[ctlr] == NULL)
  371. return -ENXIO;
  372. /*
  373.  * Root is allowed to open raw volume zero even if its not configured
  374.  * so array config can still work. I don't think I really like this,
  375.  * but I'm already using way to many device nodes to claim another one
  376.  * for "raw controller".
  377.  */
  378. if (hba[ctlr]->sizes[MINOR(inode->i_rdev)] == 0) { /* not online? */
  379. if (MINOR(inode->i_rdev) != 0)  /* not node 0? */
  380. return -ENXIO;
  381. if (!capable(CAP_SYS_ADMIN))
  382. return -EPERM;
  383. }
  385. hba[ctlr]->drv[dsk].usage_count++;
  386. hba[ctlr]->usage_count++;
  387. return 0;
  388. }
  389. /*
  390.  * Close.  Sync first.
  391.  */
  392. static int cciss_release(struct inode *inode, struct file *filep)
  393. {
  394. int ctlr = MAJOR(inode->i_rdev) - MAJOR_NR;
  395. int dsk  = MINOR(inode->i_rdev) >> NWD_SHIFT;
  397. #ifdef CCISS_DEBUG
  398. printk(KERN_DEBUG "cciss_release %x (%x:%x)n", inode->i_rdev, ctlr, dsk);
  399. #endif /* CCISS_DEBUG */
  401. /* fsync_dev(inode->i_rdev); */
  403. hba[ctlr]->drv[dsk].usage_count--;
  404. hba[ctlr]->usage_count--;
  405. return 0;
  406. }
  408. /*
  409.  * ioctl 
  410.  */
  411. static int cciss_ioctl(struct inode *inode, struct file *filep, 
  412. unsigned int cmd, unsigned long arg)
  413. {
  414. int ctlr = MAJOR(inode->i_rdev) - MAJOR_NR;
  415. int dsk  = MINOR(inode->i_rdev) >> NWD_SHIFT;
  417. #ifdef CCISS_DEBUG
  418. printk(KERN_DEBUG "cciss_ioctl: Called with cmd=%x %lxn", cmd, arg);
  419. #endif /* CCISS_DEBUG */ 
  421. switch(cmd) {
  422. case HDIO_GETGEO:
  423. {
  424. struct hd_geometry driver_geo;
  425. if (hba[ctlr]->drv[dsk].cylinders) {
  426. driver_geo.heads = hba[ctlr]->drv[dsk].heads;
  427. driver_geo.sectors = hba[ctlr]->drv[dsk].sectors;
  428. driver_geo.cylinders = hba[ctlr]->drv[dsk].cylinders;
  429. } else {
  430. driver_geo.heads = 0xff;
  431. driver_geo.sectors = 0x3f;
  432. driver_geo.cylinders = 
  433. hba[ctlr]->drv[dsk].nr_blocks / (0xff*0x3f);
  434. }
  435. driver_geo.start=
  436. hba[ctlr]->hd[MINOR(inode->i_rdev)].start_sect;
  437. if (copy_to_user((void *) arg, &driver_geo,
  438. sizeof( struct hd_geometry)))
  439. return  -EFAULT;
  440. return(0);
  441. }
  442. case HDIO_GETGEO_BIG:
  443. {
  444. struct hd_big_geometry driver_geo;
  445. if (hba[ctlr]->drv[dsk].cylinders) {
  446. driver_geo.heads = hba[ctlr]->drv[dsk].heads;
  447. driver_geo.sectors = hba[ctlr]->drv[dsk].sectors;
  448. driver_geo.cylinders = hba[ctlr]->drv[dsk].cylinders;
  449. } else {
  450. driver_geo.heads = 0xff;
  451. driver_geo.sectors = 0x3f;
  452. driver_geo.cylinders = 
  453. hba[ctlr]->drv[dsk].nr_blocks / (0xff*0x3f);
  454. }
  455. driver_geo.start= 
  456. hba[ctlr]->hd[MINOR(inode->i_rdev)].start_sect;
  457. if (copy_to_user((void *) arg, &driver_geo,  
  458. sizeof( struct hd_big_geometry)))
  459. return  -EFAULT;
  460. return(0);
  461. }
  462. case BLKGETSIZE:
  463. put_user(hba[ctlr]->hd[MINOR(inode->i_rdev)].nr_sects, (unsigned long *)arg);
  464. return 0;
  465. case BLKGETSIZE64:
  466. put_user((u64)hba[ctlr]->hd[MINOR(inode->i_rdev)].nr_sects << 9, (u64*)arg);
  467. return 0;
  468. case BLKRRPART:
  469. if(!capable(CAP_SYS_ADMIN))
  470. return -EPERM;
  471. return revalidate_logvol(inode->i_rdev, 1);
  472. case BLKFLSBUF:
  473. case BLKBSZSET:
  474. case BLKBSZGET:
  475. case BLKROSET:
  476. case BLKROGET:
  477. case BLKRASET:
  478. case BLKRAGET:
  479. case BLKPG:
  480. case BLKELVGET:
  481. case BLKELVSET:
  482. return( blk_ioctl(inode->i_rdev, cmd, arg));
  483. case CCISS_GETPCIINFO:
  484. {
  485. cciss_pci_info_struct pciinfo;
  487. if (!arg) return -EINVAL;
  488. pciinfo.bus = hba[ctlr]->pdev->bus->number;
  489. pciinfo.dev_fn = hba[ctlr]->pdev->devfn;
  490. pciinfo.board_id = hba[ctlr]->board_id;
  491. if (copy_to_user((void *) arg, &pciinfo,  sizeof( cciss_pci_info_struct )))
  492. return  -EFAULT;
  493. return(0);
  494. }
  495. case CCISS_GETINTINFO:
  496. {
  497. cciss_coalint_struct intinfo;
  498. ctlr_info_t *c = hba[ctlr];
  500. if (!arg) return -EINVAL;
  501. intinfo.delay = readl(&c->cfgtable->HostWrite.CoalIntDelay);
  502. intinfo.count = readl(&c->cfgtable->HostWrite.CoalIntCount);
  503. if (copy_to_user((void *) arg, &intinfo, sizeof( cciss_coalint_struct )))
  504. return -EFAULT;
  505.                 return(0);
  506.         }
  507. case CCISS_SETINTINFO:
  508.         {
  509.                 cciss_coalint_struct intinfo;
  510.                 ctlr_info_t *c = hba[ctlr];
  511. unsigned long flags;
  512. int i;
  514. if (!arg) return -EINVAL;
  515. if (!capable(CAP_SYS_ADMIN)) return -EPERM;
  516. if (copy_from_user(&intinfo, (void *) arg, sizeof( cciss_coalint_struct)))
  517. return -EFAULT;
  518. if ( (intinfo.delay == 0 ) && (intinfo.count == 0))
  520. {
  521. // printk("cciss_ioctl: delay and count cannot be 0n");
  522. return( -EINVAL);
  523. }
  524. spin_lock_irqsave(&io_request_lock, flags);
  525. /* Can only safely update if no commands outstanding */ 
  526. if (c->commands_outstanding > 0 )
  527. {
  528. // printk("cciss_ioctl: cannot change coalasing "
  529. // "%d commands outstanding on controllern", 
  530. // c->commands_outstanding);
  531. spin_unlock_irqrestore(&io_request_lock, flags);
  532. return(-EINVAL);
  533. }
  534. /* Update the field, and then ring the doorbell */ 
  535. writel( intinfo.delay, 
  536. &(c->cfgtable->HostWrite.CoalIntDelay));
  537. writel( intinfo.count, 
  538.                         &(c->cfgtable->HostWrite.CoalIntCount));
  539. writel( CFGTBL_ChangeReq, c->vaddr + SA5_DOORBELL);
  541. for(i=0;i<MAX_CONFIG_WAIT;i++)
  542. {
  543. if (!(readl(c->vaddr + SA5_DOORBELL) 
  544. & CFGTBL_ChangeReq))
  545. break;
  546. /* delay and try again */
  547. udelay(1000);
  548. }
  549. spin_unlock_irqrestore(&io_request_lock, flags);
  550. if (i >= MAX_CONFIG_WAIT)
  551. return( -EFAULT);
  552.                 return(0);
  553.         }
  554. case CCISS_GETNODENAME:
  555.         {
  556.                 NodeName_type NodeName;
  557.                 ctlr_info_t *c = hba[ctlr];
  558. int i; 
  560. if (!arg) return -EINVAL;
  561. for(i=0;i<16;i++)
  562. NodeName[i] = readb(&c->cfgtable->ServerName[i]);
  563.                 if (copy_to_user((void *) arg, NodeName, sizeof( NodeName_type)))
  564.                  return  -EFAULT;
  565.                 return(0);
  566.         }
  567. case CCISS_SETNODENAME:
  568. {
  569. NodeName_type NodeName;
  570. ctlr_info_t *c = hba[ctlr];
  571. unsigned long flags;
  572. int i;
  574. if (!arg) return -EINVAL;
  575. if (!capable(CAP_SYS_ADMIN)) return -EPERM;
  577. if (copy_from_user(NodeName, (void *) arg, sizeof( NodeName_type)))
  578. return -EFAULT;
  580. spin_lock_irqsave(&io_request_lock, flags);
  582. /* Update the field, and then ring the doorbell */ 
  583. for(i=0;i<16;i++)
  584. writeb( NodeName[i], &c->cfgtable->ServerName[i]);
  586. writel( CFGTBL_ChangeReq, c->vaddr + SA5_DOORBELL);
  588. for(i=0;i<MAX_CONFIG_WAIT;i++)
  589. {
  590. if (!(readl(c->vaddr + SA5_DOORBELL) 
  591. & CFGTBL_ChangeReq))
  592. break;
  593. /* delay and try again */
  594. udelay(1000);
  595. }
  596. spin_unlock_irqrestore(&io_request_lock, flags);
  597. if (i >= MAX_CONFIG_WAIT)
  598. return( -EFAULT);
  599.                 return(0);
  600.         }
  602. case CCISS_GETHEARTBEAT:
  603.         {
  604.                 Heartbeat_type heartbeat;
  605.                 ctlr_info_t *c = hba[ctlr];
  607. if (!arg) return -EINVAL;
  608.                 heartbeat = readl(&c->cfgtable->HeartBeat);
  609.                 if (copy_to_user((void *) arg, &heartbeat, sizeof( Heartbeat_type)))
  610.                  return -EFAULT;
  611.                 return(0);
  612.         }
  613. case CCISS_GETBUSTYPES:
  614.         {
  615.                 BusTypes_type BusTypes;
  616.                 ctlr_info_t *c = hba[ctlr];
  618. if (!arg) return -EINVAL;
  619.                 BusTypes = readl(&c->cfgtable->BusTypes);
  620.                 if (copy_to_user((void *) arg, &BusTypes, sizeof( BusTypes_type) ))
  621.                  return  -EFAULT;
  622.                 return(0);
  623.         }
  624. case CCISS_GETFIRMVER:
  625.         {
  626. FirmwareVer_type firmware;
  628. if (!arg) return -EINVAL;
  629. memcpy(firmware, hba[ctlr]->firm_ver, 4);
  631.                 if (copy_to_user((void *) arg, firmware, sizeof( FirmwareVer_type)))
  632.                  return -EFAULT;
  633.                 return(0);
  634.         }
  635.         case CCISS_GETDRIVVER:
  636.         {
  637. DriverVer_type DriverVer = DRIVER_VERSION;
  639.                 if (!arg) return -EINVAL;
  641.                 if (copy_to_user((void *) arg, &DriverVer, sizeof( DriverVer_type) ))
  642.                  return -EFAULT;
  643.                 return(0);
  644.         }
  646. case CCISS_GETLUNINFO:
  647. {
  648. LogvolInfo_struct luninfo;
  649. int num_parts = 0;
  650. int i, start;
  652. luninfo.LunID = hba[ctlr]->drv[dsk].LunID;
  653. luninfo.num_opens = hba[ctlr]->drv[dsk].usage_count;
  655. /* count partitions 1 to 15 with sizes > 0 */
  656.    start = (dsk << NWD_SHIFT);
  657. for(i=1; i <MAX_PART; i++) {
  658. int minor = start+i;
  659. if(hba[ctlr]->sizes[minor] != 0)
  660. num_parts++;
  661. }
  662. luninfo.num_parts = num_parts;
  663. if (copy_to_user((void *) arg, &luninfo,
  664. sizeof( LogvolInfo_struct) ))
  665. return -EFAULT;
  666. return(0);
  667. }
  668. case CCISS_PASSTHRU:
  669. {
  670. IOCTL_Command_struct iocommand;
  671. ctlr_info_t *h = hba[ctlr];
  672. CommandList_struct *c;
  673. char  *buff = NULL;
  674. u64bit temp64;
  675. unsigned long flags;
  676. DECLARE_COMPLETION(wait);
  678. if (!arg) return -EINVAL;
  680. if (!capable(CAP_SYS_RAWIO)) return -EPERM;
  682. if (copy_from_user(&iocommand, (void *) arg, sizeof( IOCTL_Command_struct) ))
  683. return -EFAULT;
  684. if((iocommand.buf_size < 1) && 
  685. (iocommand.Request.Type.Direction != XFER_NONE))
  686. {
  687. return -EINVAL;
  688. } 
  689. /* Check kmalloc limits */
  690. if(iocommand.buf_size > 128000)
  691. return -EINVAL;
  692. if(iocommand.buf_size > 0)
  693. {
  694. buff =  kmalloc(iocommand.buf_size, GFP_KERNEL);
  695. if( buff == NULL) 
  696. return -EFAULT;
  697. }
  698. if (iocommand.Request.Type.Direction == XFER_WRITE)
  699. {
  700. /* Copy the data into the buffer we created */ 
  701. if (copy_from_user(buff, iocommand.buf, iocommand.buf_size))
  702. {
  703. kfree(buff);
  704. return -EFAULT;
  705. }
  706. }
  707. if ((c = cmd_alloc(h , 0)) == NULL)
  708. {
  709. kfree(buff);
  710. return -ENOMEM;
  711. }
  712. // Fill in the command type 
  713. c->cmd_type = CMD_IOCTL_PEND;
  714. // Fill in Command Header 
  715. c->Header.ReplyQueue = 0;  // unused in simple mode
  716. if( iocommand.buf_size > 0)  // buffer to fill 
  717. {
  718. c->Header.SGList = 1;
  719. c->Header.SGTotal= 1;
  720. } else // no buffers to fill  
  721. {
  722. c->Header.SGList = 0;
  723.                  c->Header.SGTotal= 0;
  724. }
  725. c->Header.LUN = iocommand.LUN_info;
  726. c->Header.Tag.lower = c->busaddr;  // use the kernel address the cmd block for tag
  728. // Fill in Request block 
  729. c->Request = iocommand.Request; 
  731. // Fill in the scatter gather information
  732. if (iocommand.buf_size > 0 ) 
  733. {
  734. temp64.val = pci_map_single( h->pdev, buff,
  735.                                         iocommand.buf_size, 
  736.                                 PCI_DMA_BIDIRECTIONAL);
  737. c->SG[0].Addr.lower = temp64.val32.lower;
  738. c->SG[0].Addr.upper = temp64.val32.upper;
  739. c->SG[0].Len = iocommand.buf_size;
  740. c->SG[0].Ext = 0;  // we are not chaining
  741. }
  742. c->waiting = &wait;
  744. /* Put the request on the tail of the request queue */
  745. spin_lock_irqsave(&io_request_lock, flags);
  746. addQ(&h->reqQ, c);
  747. h->Qdepth++;
  748. start_io(h);
  749. spin_unlock_irqrestore(&io_request_lock, flags);
  751. wait_for_completion(&wait);
  753. /* unlock the buffers from DMA */
  754. temp64.val32.lower = c->SG[0].Addr.lower;
  755.                 temp64.val32.upper = c->SG[0].Addr.upper;
  756.                 pci_unmap_single( h->pdev, (dma_addr_t) temp64.val,
  757.                  iocommand.buf_size, PCI_DMA_BIDIRECTIONAL);
  759. /* Copy the error information out */ 
  760. iocommand.error_info = *(c->err_info);
  761. if ( copy_to_user((void *) arg, &iocommand, sizeof( IOCTL_Command_struct) ) )
  762. {
  763. kfree(buff);
  764. cmd_free(h, c, 0);
  765. return( -EFAULT);
  766. } 
  768. if (iocommand.Request.Type.Direction == XFER_READ)
  769.                 {
  770.                         /* Copy the data out of the buffer we created */
  771.                         if (copy_to_user(iocommand.buf, buff, iocommand.buf_size))
  772. {
  773.                          kfree(buff);
  774. cmd_free(h, c, 0);
  775. return -EFAULT;
  776. }
  777.                 }
  778.                 kfree(buff);
  779. cmd_free(h, c, 0);
  780.                 return(0);
  781. } 
  783. default:
  784. return -EBADRQC;
  785. }
  787. }
  789. /* Borrowed and adapted from sd.c */
  790. static int revalidate_logvol(kdev_t dev, int maxusage)
  791. {
  792.         int ctlr, target;
  793.         struct gendisk *gdev;
  794.         unsigned long flags;
  795.         int max_p;
  796.         int start;
  797.         int i;
  799.         target = MINOR(dev) >> NWD_SHIFT;
  800.         ctlr = MAJOR(dev) - MAJOR_NR;
  801.         gdev = &(hba[ctlr]->gendisk);
  803.         spin_lock_irqsave(&io_request_lock, flags);
  804.         if (hba[ctlr]->drv[target].usage_count > maxusage) {
  805.                 spin_unlock_irqrestore(&io_request_lock, flags);
  806.                 printk(KERN_WARNING "cciss: Device busy for "
  807.                         "revalidation (usage=%d)n",
  808.                         hba[ctlr]->drv[target].usage_count);
  809.                 return -EBUSY;
  810.         }
  811.         hba[ctlr]->drv[target].usage_count++;
  812.         spin_unlock_irqrestore(&io_request_lock, flags);
  814.         max_p = gdev->max_p;
  815.         start = target << gdev->minor_shift;
  817.         for(i=max_p-1; i>=0; i--) {
  818.                 int minor = start+i;
  819.                 invalidate_device(MKDEV(MAJOR_NR + ctlr, minor), 1);
  820.                 gdev->part[minor].start_sect = 0;
  821.                 gdev->part[minor].nr_sects = 0;
  823.                 /* reset the blocksize so we can read the partition table */
  824.                 blksize_size[MAJOR_NR+ctlr][minor] = 1024;
  825.         }
  826. /* setup partitions per disk */
  827. grok_partitions(gdev, target, MAX_PART, 
  828. hba[ctlr]->drv[target].nr_blocks);
  829.         hba[ctlr]->drv[target].usage_count--;
  830.         return 0;
  831. }
  833. static int frevalidate_logvol(kdev_t dev)
  834. {
  835. #ifdef CCISS_DEBUG
  836. printk(KERN_DEBUG "cciss: frevalidate has been calledn");
  837. #endif /* CCISS_DEBUG */ 
  838. return revalidate_logvol(dev, 0);
  839. }
  840. /*
  841.  *   Wait polling for a command to complete.
  842.  *   The memory mapped FIFO is polled for the completion.
  843.  *   Used only at init time, interrupts disabled.
  844.  */
  845. static unsigned long pollcomplete(int ctlr)
  846. {
  847.         unsigned long done;
  848.         int i;
  850.         /* Wait (up to 2 seconds) for a command to complete */
  852.         for (i = 200000; i > 0; i--) {
  853.                 done = hba[ctlr]->access.command_completed(hba[ctlr]);
  854.                 if (done == FIFO_EMPTY) {
  855.                         udelay(10);     /* a short fixed delay */
  856.                 } else
  857.                         return (done);
  858.         }
  859.         /* Invalid address to tell caller we ran out of time */
  860.         return 1;
  861. }
  862. /*
  863.  * Send a command to the controller, and wait for it to complete.  
  864.  * Only used at init time. 
  865.  */
  866. static int sendcmd(
  867. __u8 cmd,
  868. int ctlr,
  869. void *buff,
  870. size_t size,
  871. unsigned int use_unit_num, /* 0: address the controller,
  872.       1: address logical volume log_unit,
  873.       2: periph device address is scsi3addr */
  874. unsigned int log_unit,
  875. __u8 page_code,
  876. unsigned char *scsi3addr)
  877. {
  878. CommandList_struct *c;
  879. int i;
  880. unsigned long complete;
  881. ctlr_info_t *info_p= hba[ctlr];
  882. u64bit buff_dma_handle;
  884. c = cmd_alloc(info_p, 1);
  885. if (c == NULL)
  886. {
  887. printk(KERN_WARNING "cciss: unable to get memory");
  888. return(IO_ERROR);
  889. }
  890. // Fill in Command Header 
  891. c->Header.ReplyQueue = 0;  // unused in simple mode
  892. if( buff != NULL)  // buffer to fill 
  893. {
  894. c->Header.SGList = 1;
  895. c->Header.SGTotal= 1;
  896. } else // no buffers to fill  
  897. {
  898. c->Header.SGList = 0;
  899.                 c->Header.SGTotal= 0;
  900. }
  901. c->Header.Tag.lower = c->busaddr;  // use the kernel address the cmd block for tag
  902. // Fill in Request block 
  903. switch(cmd)
  904. {
  905. case  CISS_INQUIRY:
  906. /* If the logical unit number is 0 then, this is going
  907. to controller so It's a physical command
  908. mode = 0 target = 0.
  909. So we have nothing to write. 
  910. otherwise, if use_unit_num == 1,
  911. mode = 1(volume set addressing) target = LUNID
  912. otherwise, if use_unit_num == 2,
  913. mode = 0(periph dev addr) target = scsi3addr
  914. */
  915. if(use_unit_num == 1)
  916. {
  917. c->Header.LUN.LogDev.VolId=
  918.                                  hba[ctlr]->drv[log_unit].LunID;
  919.                          c->Header.LUN.LogDev.Mode = 1;
  920. }
  921. else if (use_unit_num == 2)
  922. {
  923. memcpy(c->Header.LUN.LunAddrBytes,scsi3addr,8);
  924. c->Header.LUN.LogDev.Mode = 0; // phys dev addr
  925. }
  927. /* are we trying to read a vital product page */
  928. if(page_code != 0)
  929. {
  930. c->Request.CDB[1] = 0x01;
  931. c->Request.CDB[2] = page_code;
  932. }
  933. c->Request.CDBLen = 6;
  934. c->Request.Type.Type =  TYPE_CMD; // It is a command. 
  935. c->Request.Type.Attribute = ATTR_SIMPLE;  
  936. c->Request.Type.Direction = XFER_READ; // Read 
  937. c->Request.Timeout = 0; // Don't time out 
  938. c->Request.CDB[0] =  CISS_INQUIRY;
  939. c->Request.CDB[4] = size  & 0xFF;  
  940. break;
  941. case CISS_REPORT_LOG:
  942. case CISS_REPORT_PHYS:
  943.                         /* Talking to controller so It's a physical command
  944.                                 mode = 00 target = 0.
  945.                                 So we have nothing to write.
  946.                         */
  947.                         c->Request.CDBLen = 12;
  948.                         c->Request.Type.Type =  TYPE_CMD; // It is a command.
  949.                         c->Request.Type.Attribute = ATTR_SIMPLE; 
  950.                         c->Request.Type.Direction = XFER_READ; // Read
  951.                         c->Request.Timeout = 0; // Don't time out
  952. c->Request.CDB[0] = cmd;
  953.                         c->Request.CDB[6] = (size >> 24) & 0xFF;  //MSB
  954.                         c->Request.CDB[7] = (size >> 16) & 0xFF;
  955.                         c->Request.CDB[8] = (size >> 8) & 0xFF;
  956.                         c->Request.CDB[9] = size & 0xFF;
  957.                 break;
  959. case CCISS_READ_CAPACITY:
  960. c->Header.LUN.LogDev.VolId= 
  961. hba[ctlr]->drv[log_unit].LunID;
  962. c->Header.LUN.LogDev.Mode = 1;
  963. c->Request.CDBLen = 10;
  964.                         c->Request.Type.Type =  TYPE_CMD; // It is a command.
  965.                         c->Request.Type.Attribute = ATTR_SIMPLE; 
  966.                         c->Request.Type.Direction = XFER_READ; // Read
  967.                         c->Request.Timeout = 0; // Don't time out
  968.                         c->Request.CDB[0] = CCISS_READ_CAPACITY;
  969. break;
  970. case CCISS_CACHE_FLUSH:
  971. c->Request.CDBLen = 12;
  972. c->Request.Type.Type =  TYPE_CMD; // It is a command.
  973. c->Request.Type.Attribute = ATTR_SIMPLE;
  974. c->Request.Type.Direction = XFER_WRITE; // No data
  975. c->Request.Timeout = 0; // Don't time out
  976. c->Request.CDB[0] = BMIC_WRITE;  // BMIC Passthru
  977. c->Request.CDB[6] = BMIC_CACHE_FLUSH;
  978. break;
  979. default:
  980. printk(KERN_WARNING
  981. "cciss:  Unknown Command 0x%c sent attemptedn",
  982.   cmd);
  983. cmd_free(info_p, c, 1);
  984. return(IO_ERROR);
  985. };
  986. // Fill in the scatter gather information
  987. if (size > 0 ) 
  988. {
  989. buff_dma_handle.val = (__u64) pci_map_single( info_p->pdev, 
  990. buff, size, PCI_DMA_BIDIRECTIONAL);
  991. c->SG[0].Addr.lower = buff_dma_handle.val32.lower;
  992. c->SG[0].Addr.upper = buff_dma_handle.val32.upper;
  993. c->SG[0].Len = size;
  994. c->SG[0].Ext = 0;  // we are not chaining
  995. }
  996. /*
  997.          * Disable interrupt
  998.          */
  999. #ifdef CCISS_DEBUG
  1000. printk(KERN_DEBUG "cciss: turning intr offn");
  1001. #endif /* CCISS_DEBUG */ 
  1002.         info_p->access.set_intr_mask(info_p, CCISS_INTR_OFF);
  1004. /* Make sure there is room in the command FIFO */
  1005.         /* Actually it should be completely empty at this time. */
  1006.         for (i = 200000; i > 0; i--) 
  1007. {
  1008. /* if fifo isn't full go */
  1009.                 if (!(info_p->access.fifo_full(info_p))) 
  1010. {
  1012.                         break;
  1013.                 }
  1014.                 udelay(10);
  1015.                 printk(KERN_WARNING "cciss cciss%d: SendCmd FIFO full,"
  1016.                         " waiting!n", ctlr);
  1017.         }
  1018.         /*
  1019.          * Send the cmd
  1020.          */
  1021.         info_p->access.submit_command(info_p, c);
  1022.         complete = pollcomplete(ctlr);
  1024. #ifdef CCISS_DEBUG
  1025. printk(KERN_DEBUG "cciss: command completedn");
  1026. #endif /* CCISS_DEBUG */
  1028. /* unlock the data buffer from DMA */
  1029. pci_unmap_single(info_p->pdev, (dma_addr_t) buff_dma_handle.val,
  1030.                                 size, PCI_DMA_BIDIRECTIONAL);
  1031. if (complete != 1) {
  1032. if ( (complete & CISS_ERROR_BIT)
  1033.      && (complete & ~CISS_ERROR_BIT) == c->busaddr)
  1034.      {
  1035. /* if data overrun or underun on Report command 
  1036. ignore it 
  1037. */
  1038. if (((c->Request.CDB[0] == CISS_REPORT_LOG) ||
  1039.      (c->Request.CDB[0] == CISS_REPORT_PHYS) ||
  1040.      (c->Request.CDB[0] == CISS_INQUIRY)) &&
  1041. ((c->err_info->CommandStatus == 
  1042. CMD_DATA_OVERRUN) || 
  1043.  (c->err_info->CommandStatus == 
  1044. CMD_DATA_UNDERRUN)
  1045.   ))
  1046. {
  1047. complete = c->busaddr;
  1048. } else
  1049. {
  1050. printk(KERN_WARNING "ciss ciss%d: sendcmd"
  1051. " Error %x n", ctlr, 
  1052. c->err_info->CommandStatus); 
  1053. printk(KERN_WARNING "ciss ciss%d: sendcmd"
  1054. " offensive infon"
  1055. "  size %xn   num %x   value %xn", ctlr,
  1056.   c->err_info->MoreErrInfo.Invalid_Cmd.offense_size,
  1057.   c->err_info->MoreErrInfo.Invalid_Cmd.offense_num,
  1058.   c->err_info->MoreErrInfo.Invalid_Cmd.offense_value);
  1059. cmd_free(info_p,c, 1);
  1060. return(IO_ERROR);
  1061. }
  1062. }
  1063.                 if (complete != c->busaddr) {
  1064.                         printk( KERN_WARNING "cciss cciss%d: SendCmd "
  1065.                       "Invalid command list address returned! (%lx)n",
  1066.                                 ctlr, complete);
  1067.                         cmd_free(info_p, c, 1);
  1068.                         return (IO_ERROR);
  1069.                 }
  1070.         } else {
  1071.                 printk( KERN_WARNING
  1072.                         "cciss cciss%d: SendCmd Timeout out, "
  1073.                         "No command list address returned!n",
  1074.                         ctlr);
  1075.                 cmd_free(info_p, c, 1);
  1076.                 return (IO_ERROR);
  1077.         }
  1078. cmd_free(info_p, c, 1);
  1079.         return (IO_OK);
  1080. } 
  1081. /*
  1082.  * Map (physical) PCI mem into (virtual) kernel space
  1083.  */
  1084. static ulong remap_pci_mem(ulong base, ulong size)
  1085. {
  1086.         ulong page_base        = ((ulong) base) & PAGE_MASK;
  1087.         ulong page_offs        = ((ulong) base) - page_base;
  1088.         ulong page_remapped    = (ulong) ioremap(page_base, page_offs+size);
  1090.         return (ulong) (page_remapped ? (page_remapped + page_offs) : 0UL);
  1091. }
  1093. /*
  1094.  * Enqueuing and dequeuing functions for cmdlists.
  1095.  */
  1096. static inline void addQ(CommandList_struct **Qptr, CommandList_struct *c)
  1097. {
  1098.         if (*Qptr == NULL) {
  1099.                 *Qptr = c;
  1100.                 c->next = c->prev = c;
  1101.         } else {
  1102.                 c->prev = (*Qptr)->prev;
  1103.                 c->next = (*Qptr);
  1104.                 (*Qptr)->prev->next = c;
  1105.                 (*Qptr)->prev = c;
  1106.         }
  1107. }
  1109. static inline CommandList_struct *removeQ(CommandList_struct **Qptr, 
  1110. CommandList_struct *c)
  1111. {
  1112.         if (c && c->next != c) {
  1113.                 if (*Qptr == c) *Qptr = c->next;
  1114.                 c->prev->next = c->next;
  1115.                 c->next->prev = c->prev;
  1116.         } else {
  1117.                 *Qptr = NULL;
  1118.         }
  1119.         return c;
  1120. }
  1122. /* 
  1123.  * Takes jobs of the Q and sends them to the hardware, then puts it on 
  1124.  * the Q to wait for completion. 
  1125.  */ 
  1126. static void start_io( ctlr_info_t *h)
  1127. {
  1128. CommandList_struct *c;
  1130. while(( c = h->reqQ) != NULL )
  1131. {
  1132. /* can't do anything if fifo is full */
  1133. if ((h->access.fifo_full(h)))
  1134. {
  1135. printk(KERN_WARNING "cciss: fifo full n");
  1136. return;
  1137. }
  1138. /* Get the frist entry from the Request Q */ 
  1139. removeQ(&(h->reqQ), c);
  1140. h->Qdepth--;
  1142. /* Tell the controller execute command */ 
  1143. h->access.submit_command(h, c);
  1145. /* Put job onto the completed Q */ 
  1146. addQ (&(h->cmpQ), c); 
  1147. }
  1148. }
  1150. static inline void complete_buffers( struct buffer_head *bh, int status)
  1151. {
  1152. struct buffer_head *xbh;
  1154. while(bh)
  1155. {
  1156. xbh = bh->b_reqnext; 
  1157. bh->b_reqnext = NULL; 
  1158. blk_finished_io(bh->b_size >> 9);
  1159. bh->b_end_io(bh, status);
  1160. bh = xbh;
  1161. }
  1162. } 
  1163. /* checks the status of the job and calls complete buffers to mark all 
  1164.  * buffers for the completed job. 
  1165.  */ 
  1166. static inline void complete_command( CommandList_struct *cmd, int timeout)
  1167. {
  1168. int status = 1;
  1169. int i, ddir;
  1170. u64bit temp64;
  1172. if (timeout)
  1173. status = 0; 
  1174. /* unmap the DMA mapping for all the scatter gather elements */
  1175. if (cmd->Request.Type.Direction == XFER_READ)
  1176. ddir = PCI_DMA_FROMDEVICE;
  1177. else
  1178. ddir = PCI_DMA_TODEVICE;
  1179. for(i=0; i<cmd->Header.SGList; i++)
  1180. {
  1181. temp64.val32.lower = cmd->SG[i].Addr.lower;
  1182. temp64.val32.upper = cmd->SG[i].Addr.upper;
  1183. pci_unmap_page(hba[cmd->ctlr]->pdev,
  1184. temp64.val, cmd->SG[i].Len, ddir);
  1185. }
  1187. if(cmd->err_info->CommandStatus != 0) 
  1188. { /* an error has occurred */ 
  1189. switch(cmd->err_info->CommandStatus)
  1190. {
  1191. unsigned char sense_key;
  1192. case CMD_TARGET_STATUS:
  1193. status = 0;
  1195. if( cmd->err_info->ScsiStatus == 0x02) {
  1196. printk(KERN_WARNING "cciss: cmd %p "
  1197. "has CHECK CONDITION,"
  1198. " sense key = 0x%xn", cmd,
  1199. cmd->err_info->SenseInfo[2]);
  1200. /* check the sense key */
  1201. sense_key = 0xf & 
  1202. cmd->err_info->SenseInfo[2];
  1203. /* no status or recovered error */
  1204. if ((sense_key == 0x0) ||
  1205. (sense_key == 0x1))
  1206. status = 1;
  1207. } else {
  1208. printk(KERN_WARNING "cciss: cmd %p "
  1209. "has SCSI Status 0x%xn",
  1210. cmd, cmd->err_info->ScsiStatus);
  1211. }
  1212. break;
  1213. case CMD_DATA_UNDERRUN:
  1214. printk(KERN_WARNING "cciss: cmd %p has"
  1215. " completed with data underrun "
  1216. "reportedn", cmd);
  1217. break;
  1218. case CMD_DATA_OVERRUN:
  1219. printk(KERN_WARNING "cciss: cmd %p has"
  1220. " completed with data overrun "
  1221. "reportedn", cmd);
  1222. break;
  1223. case CMD_INVALID:
  1224. printk(KERN_WARNING "cciss: cmd %p is "
  1225. "reported invalidn", cmd);
  1226. status = 0;
  1227. break;
  1228. case CMD_PROTOCOL_ERR:
  1229.                                 printk(KERN_WARNING "cciss: cmd %p has "
  1230. "protocol error n", cmd);
  1231.                                 status = 0;
  1232.                         break;
  1233. case CMD_HARDWARE_ERR:
  1234.                                 printk(KERN_WARNING "cciss: cmd %p had " 
  1235.                                         " hardware errorn", cmd);
  1236.                                 status = 0;
  1237.                         break;
  1238. case CMD_CONNECTION_LOST:
  1239. printk(KERN_WARNING "cciss: cmd %p had "
  1240. "connection lostn", cmd);
  1241. status=0;
  1242. break;
  1243. case CMD_ABORTED:
  1244. printk(KERN_WARNING "cciss: cmd %p was "
  1245. "abortedn", cmd);
  1246. status=0;
  1247. break;
  1248. case CMD_ABORT_FAILED:
  1249. printk(KERN_WARNING "cciss: cmd %p reports "
  1250. "abort failedn", cmd);
  1251. status=0;
  1252. break;
  1253. case CMD_UNSOLICITED_ABORT:
  1254. printk(KERN_WARNING "cciss: cmd %p aborted "
  1255. "do to an unsolicited abortn", cmd);
  1256. status=0;
  1257. break;
  1258. case CMD_TIMEOUT:
  1259. printk(KERN_WARNING "cciss: cmd %p timedoutn",
  1260. cmd);
  1261. status=0;
  1262. break;
  1263. default:
  1264. printk(KERN_WARNING "cciss: cmd %p returned "
  1265. "unknown status %xn", cmd, 
  1266. cmd->err_info->CommandStatus); 
  1267. status=0;
  1268. }
  1269. }
  1270. complete_buffers(cmd->rq->bh, status);
  1272. #ifdef CCISS_DEBUG
  1273. printk("Done with %pn", cmd->rq);
  1274. #endif /* CCISS_DEBUG */ 
  1275. end_that_request_last(cmd->rq);
  1276. }
  1279. static inline int cpq_new_segment(request_queue_t *q, struct request *rq,
  1280.                                   int max_segments)
  1281. {
  1282.         if (rq->nr_segments < MAXSGENTRIES) {
  1283.                 rq->nr_segments++;
  1284.                 return 1;
  1285.         }
  1286.         return 0;
  1287. }
  1289. static int cpq_back_merge_fn(request_queue_t *q, struct request *rq,
  1290.                              struct buffer_head *bh, int max_segments)
  1291. {
  1292. if (blk_seg_merge_ok(rq->bhtail, bh))
  1293.                 return 1;
  1294.         return cpq_new_segment(q, rq, max_segments);
  1295. }
  1297. static int cpq_front_merge_fn(request_queue_t *q, struct request *rq,
  1298.                              struct buffer_head *bh, int max_segments)
  1299. {
  1300. if (blk_seg_merge_ok(bh, rq->bh))
  1301.                 return 1;
  1302.         return cpq_new_segment(q, rq, max_segments);
  1303. }
  1305. static int cpq_merge_requests_fn(request_queue_t *q, struct request *rq,
  1306.                                  struct request *nxt, int max_segments)
  1307. {
  1308.         int total_segments = rq->nr_segments + nxt->nr_segments;
  1310. if (blk_seg_merge_ok(rq->bhtail, nxt->bh))
  1311.                 total_segments--;
  1313.         if (total_segments > MAXSGENTRIES)
  1314.                 return 0;
  1316.         rq->nr_segments = total_segments;
  1317.         return 1;
  1318. }
  1320. /* 
  1321.  * Get a request and submit it to the controller. 
  1322.  * Currently we do one request at a time.  Ideally we would like to send
  1323.  * everything to the controller on the first call, but there is a danger
  1324.  * of holding the io_request_lock for to long.  
  1325.  */
  1326. static void do_cciss_request(request_queue_t *q)
  1327. {
  1328. ctlr_info_t *h= q->queuedata; 
  1329. CommandList_struct *c;
  1330. int log_unit, start_blk, seg;
  1331. unsigned long long lastdataend;
  1332. struct buffer_head *bh;
  1333. struct list_head *queue_head = &q->queue_head;
  1334. struct request *creq;
  1335. u64bit temp64;
  1336. struct scatterlist tmp_sg[MAXSGENTRIES];
  1337. int i, ddir;
  1339. if (q->plugged)
  1340. goto startio;
  1342. next:
  1343. if (list_empty(queue_head))
  1344. goto startio;
  1346. creq = blkdev_entry_next_request(queue_head); 
  1347. if (creq->nr_segments > MAXSGENTRIES)
  1348.                 BUG();
  1350.         if (h->ctlr != MAJOR(creq->rq_dev)-MAJOR_NR )
  1351.         {
  1352.                 printk(KERN_WARNING "doreq cmd for %d, %x at %pn",
  1353.                                 h->ctlr, creq->rq_dev, creq);
  1354.                 blkdev_dequeue_request(creq);
  1355.                 complete_buffers(creq->bh, 0);
  1356. end_that_request_last(creq);
  1357. goto startio;
  1358.         }
  1360. if (( c = cmd_alloc(h, 1)) == NULL)
  1361. goto startio;
  1363. blkdev_dequeue_request(creq);
  1365. spin_unlock_irq(&io_request_lock);
  1367. c->cmd_type = CMD_RWREQ;      
  1368. c->rq = creq;
  1369. bh = creq->bh;
  1371. /* fill in the request */ 
  1372. log_unit = MINOR(creq->rq_dev) >> NWD_SHIFT; 
  1373. c->Header.ReplyQueue = 0;  // unused in simple mode
  1374. c->Header.Tag.lower = c->busaddr;  // use the physical address the cmd block for tag
  1375. c->Header.LUN.LogDev.VolId= hba[h->ctlr]->drv[log_unit].LunID;
  1376. c->Header.LUN.LogDev.Mode = 1;
  1377. c->Request.CDBLen = 10; // 12 byte commands not in FW yet;
  1378. c->Request.Type.Type =  TYPE_CMD; // It is a command. 
  1379. c->Request.Type.Attribute = ATTR_SIMPLE; 
  1380. c->Request.Type.Direction = 
  1381. (creq->cmd == READ) ? XFER_READ: XFER_WRITE; 
  1382. c->Request.Timeout = 0; // Don't time out
  1383. c->Request.CDB[0] = (creq->cmd == READ) ? CCISS_READ : CCISS_WRITE;
  1384. start_blk = hba[h->ctlr]->hd[MINOR(creq->rq_dev)].start_sect + creq->sector;
  1385. #ifdef CCISS_DEBUG
  1386. if (bh == NULL)
  1387. panic("cciss: bh== NULL?");
  1388. printk(KERN_DEBUG "ciss: sector =%d nr_sectors=%dn",(int) creq->sector,
  1389. (int) creq->nr_sectors);
  1390. #endif /* CCISS_DEBUG */
  1391. seg = 0;
  1392. lastdataend = ~0ULL;
  1393. while(bh)
  1394. {
  1395. if (bh_phys(bh) == lastdataend)
  1396. {  // tack it on to the last segment 
  1397. tmp_sg[seg-1].length +=bh->b_size;
  1398. lastdataend += bh->b_size;
  1399. } else
  1400. {
  1401. if (seg == MAXSGENTRIES)
  1402. BUG();
  1403. tmp_sg[seg].page = bh->b_page;
  1404. tmp_sg[seg].length = bh->b_size;
  1405. tmp_sg[seg].offset = bh_offset(bh);
  1406. lastdataend = bh_phys(bh) + bh->b_size;
  1407. seg++;
  1408. }
  1409. bh = bh->b_reqnext;
  1410. }
  1412. /* get the DMA records for the setup */ 
  1413. if (c->Request.Type.Direction == XFER_READ)
  1414. ddir = PCI_DMA_FROMDEVICE;
  1415. else
  1416. ddir = PCI_DMA_TODEVICE;
  1417. for (i=0; i<seg; i++) {
  1418. c->SG[i].Len = tmp_sg[i].length;
  1419. temp64.val = pci_map_page(h->pdev, tmp_sg[i].page,
  1420.     tmp_sg[i].offset, tmp_sg[i].length, ddir);
  1421. c->SG[i].Addr.lower = temp64.val32.lower;
  1422.                 c->SG[i].Addr.upper = temp64.val32.upper;
  1423.                 c->SG[i].Ext = 0;  // we are not chaining
  1424. }
  1425. /* track how many SG entries we are using */ 
  1426. if( seg > h->maxSG)
  1427. h->maxSG = seg; 
  1429. #ifdef CCISS_DEBUG
  1430. printk(KERN_DEBUG "cciss: Submitting %d sectors in %d segmentsn", sect, seg);
  1431. #endif /* CCISS_DEBUG */
  1433. c->Header.SGList = c->Header.SGTotal = seg;
  1434. c->Request.CDB[1]= 0;
  1435. c->Request.CDB[2]= (start_blk >> 24) & 0xff; //MSB
  1436. c->Request.CDB[3]= (start_blk >> 16) & 0xff;
  1437. c->Request.CDB[4]= (start_blk >>  8) & 0xff;
  1438. c->Request.CDB[5]= start_blk & 0xff;
  1439. c->Request.CDB[6]= 0; // (sect >> 24) & 0xff; MSB
  1440. c->Request.CDB[7]= (creq->nr_sectors >>  8) & 0xff; 
  1441. c->Request.CDB[8]= creq->nr_sectors & 0xff; 
  1442. c->Request.CDB[9] = c->Request.CDB[11] = c->Request.CDB[12] = 0;
  1444. spin_lock_irq(&io_request_lock);
  1446. addQ(&(h->reqQ),c);
  1447. h->Qdepth++;
  1448. if(h->Qdepth > h->maxQsinceinit)
  1449. h->maxQsinceinit = h->Qdepth; 
  1451. goto next;
  1453. startio:
  1454. start_io(h);
  1455. }
  1457. static void do_cciss_intr(int irq, void *dev_id, struct pt_regs *regs)
  1458. {
  1459. ctlr_info_t *h = dev_id;
  1460. CommandList_struct *c;
  1461. unsigned long flags;
  1462. __u32 a, a1;
  1465. /* Is this interrupt for us? */
  1466. if ( h->access.intr_pending(h) == 0)
  1467. return;
  1469. /*
  1470.  * If there are completed commands in the completion queue,
  1471.  * we had better do something about it.
  1472.  */
  1473. spin_lock_irqsave(&io_request_lock, flags);
  1474. while( h->access.intr_pending(h))
  1475. {
  1476. while((a = h->access.command_completed(h)) != FIFO_EMPTY) 
  1477. {
  1478. a1 = a;
  1479. a &= ~3;
  1480. if ((c = h->cmpQ) == NULL)
  1481. {  
  1482. printk(KERN_WARNING "cciss: Completion of %08lx ignoredn", (unsigned long)a1);
  1483. continue;
  1484. } 
  1485. while(c->busaddr != a) {
  1486. c = c->next;
  1487. if (c == h->cmpQ) 
  1488. break;
  1489. }
  1490. /*
  1491.  * If we've found the command, take it off the
  1492.  * completion Q and free it
  1493.  */
  1494.  if (c->busaddr == a) {
  1495. removeQ(&h->cmpQ, c);
  1496. if (c->cmd_type == CMD_RWREQ) {
  1497. complete_command(c, 0);
  1498. cmd_free(h, c, 1);
  1499. } else if (c->cmd_type == CMD_IOCTL_PEND) {
  1500. complete(c->waiting);
  1501. }
  1502. # ifdef CONFIG_CISS_SCSI_TAPE
  1503. else if (c->cmd_type == CMD_SCSI) {
  1504. complete_scsi_command(c, 0, a1);
  1505. }
  1506. # endif
  1507. continue;
  1508. }
  1509. }
  1510. }
  1511. /*
  1512.  * See if we can queue up some more IO
  1513.  */
  1514. do_cciss_request(BLK_DEFAULT_QUEUE(MAJOR_NR + h->ctlr));
  1515. spin_unlock_irqrestore(&io_request_lock, flags);
  1516. }
  1517. /* 
  1518.  *  We cannot read the structure directly, for portablity we must use 
  1519.  *   the io functions.
  1520.  *   This is for debug only. 
  1521.  */
  1522. #ifdef CCISS_DEBUG
  1523. static void print_cfg_table( CfgTable_struct *tb)
  1524. {
  1525. int i;
  1526. char temp_name[17];
  1528. printk("Controller Configuration informationn");
  1529. printk("------------------------------------n");
  1530. for(i=0;i<4;i++)
  1531. temp_name[i] = readb(&(tb->Signature[i]));
  1532. temp_name[4]='';
  1533. printk("   Signature = %sn", temp_name); 
  1534. printk("   Spec Number = %dn", readl(&(tb->SpecValence)));
  1535. printk("   Transport methods supported = 0x%xn", 
  1536. readl(&(tb-> TransportSupport)));
  1537. printk("   Transport methods active = 0x%xn", 
  1538. readl(&(tb->TransportActive)));
  1539. printk("   Requested transport Method = 0x%xn", 
  1540. readl(&(tb->HostWrite.TransportRequest)));
  1541. printk("   Coalese Interrupt Delay = 0x%xn", 
  1542. readl(&(tb->HostWrite.CoalIntDelay)));
  1543. printk("   Coalese Interrupt Count = 0x%xn", 
  1544. readl(&(tb->HostWrite.CoalIntCount)));
  1545. printk("   Max outstanding commands = 0x%dn", 
  1546. readl(&(tb->CmdsOutMax)));
  1547. printk("   Bus Types = 0x%xn", readl(&(tb-> BusTypes)));
  1548. for(i=0;i<16;i++)
  1549. temp_name[i] = readb(&(tb->ServerName[i]));
  1550. temp_name[16] = '';
  1551. printk("   Server Name = %sn", temp_name);
  1552. printk("   Heartbeat Counter = 0x%xnnn", 
  1553. readl(&(tb->HeartBeat)));
  1554. }
  1555. #endif /* CCISS_DEBUG */ 
  1557. static void release_io_mem(ctlr_info_t *c)
  1558. {
  1559. /* if IO mem was not protected do nothing */
  1560. if( c->io_mem_addr == 0)
  1561. return;
  1562. release_region(c->io_mem_addr, c->io_mem_length);
  1563. c->io_mem_addr = 0;
  1564. c->io_mem_length = 0;
  1565. }
  1566. static int cciss_pci_init(ctlr_info_t *c, struct pci_dev *pdev)
  1567. {
  1568. ushort vendor_id, device_id, command;
  1569. unchar cache_line_size, latency_timer;
  1570. unchar irq, revision;
  1571. uint addr[6];
  1572. __u32 board_id;
  1573. int cfg_offset;
  1574. int cfg_base_addr;
  1575. int cfg_base_addr_index;
  1576. int i;
  1578. vendor_id = pdev->vendor;
  1579. device_id = pdev->device;
  1580. irq = pdev->irq;
  1582. for(i=0; i<6; i++)
  1583. addr[i] = pdev->resource[i].start;
  1585. if (pci_enable_device(pdev))
  1586. {
  1587. printk(KERN_ERR "cciss: Unable to Enable PCI devicen");
  1588. return( -1);
  1589. }
  1590. if (pci_set_dma_mask(pdev, CCISS_DMA_MASK ) != 0)
  1591. {
  1592. printk(KERN_ERR "cciss:  Unable to set DMA maskn");
  1593. return(-1);
  1594. }
  1596. (void) pci_read_config_word(pdev, PCI_COMMAND,&command);
  1597. (void) pci_read_config_byte(pdev, PCI_CLASS_REVISION, &revision);
  1598. (void) pci_read_config_byte(pdev, PCI_CACHE_LINE_SIZE,
  1599. &cache_line_size);
  1600. (void) pci_read_config_byte(pdev, PCI_LATENCY_TIMER,
  1601. &latency_timer);
  1603. (void) pci_read_config_dword(pdev, PCI_SUBSYSTEM_VENDOR_ID, 
  1604. &board_id);
  1606. /* check to see if controller has been disabled */
  1607. if (!(command & 0x02)) {
  1608. printk(KERN_WARNING "cciss: controller appears to be disabledn");
  1609. return(-1);
  1610. }
  1611. /* search for our IO range so we can protect it */
  1612. for (i=0; i<6; i++) {
  1613. /* is this an IO range */
  1614. if (pdev->resource[i].flags & 0x01) {
  1615. c->io_mem_addr = pdev->resource[i].start;
  1616. c->io_mem_length = pdev->resource[i].end -
  1617. pdev->resource[i].start +1; 
  1618. #ifdef CCISS_DEBUG
  1619. printk("IO value found base_addr[%d] %lx %lxn", i,
  1620. c->io_mem_addr, c->io_mem_length);
  1621. #endif /* CCISS_DEBUG */
  1622. /* register the IO range */
  1623. if (!request_region( c->io_mem_addr,
  1624.                                         c->io_mem_length, "cciss")) {
  1625. printk(KERN_WARNING 
  1626. "cciss I/O memory range already in "
  1627. "use addr=%lx length=%ldn",
  1628. c->io_mem_addr, c->io_mem_length);
  1629. c->io_mem_addr= 0;
  1630. c->io_mem_length = 0;
  1631. }
  1632. break;
  1633. }
  1634. }
  1636. #ifdef CCISS_DEBUG
  1637. printk("vendor_id = %xn", vendor_id);
  1638. printk("device_id = %xn", device_id);
  1639. printk("command = %xn", command);
  1640. for(i=0; i<6; i++)
  1641. printk("addr[%d] = %xn", i, addr[i]);
  1642. printk("revision = %xn", revision);
  1643. printk("irq = %xn", irq);
  1644. printk("cache_line_size = %xn", cache_line_size);
  1645. printk("latency_timer = %xn", latency_timer);
  1646. printk("board_id = %xn", board_id);
  1647. #endif /* CCISS_DEBUG */ 
  1649. c->intr = irq;
  1651. /*
  1652.  * Memory base addr is first addr , the second points to the config
  1653.          *   table
  1654.  */
  1656. c->paddr = addr[0] ; /* addressing mode bits already removed */
  1657. #ifdef CCISS_DEBUG
  1658. printk("address 0 = %xn", c->paddr);
  1659. #endif /* CCISS_DEBUG */ 
  1660. c->vaddr = remap_pci_mem(c->paddr, 200);
  1662. /* get the address index number */
  1663. cfg_base_addr = readl(c->vaddr + SA5_CTCFG_OFFSET);
  1664. /* I am not prepared to deal with a 64 bit address value */
  1665. cfg_base_addr &= 0xffff;
  1666. #ifdef CCISS_DEBUG
  1667. printk("cfg base address = %xn", cfg_base_addr);
  1668. #endif /* CCISS_DEBUG */
  1669. cfg_base_addr_index = (cfg_base_addr  - PCI_BASE_ADDRESS_0)/4;
  1670. #ifdef CCISS_DEBUG
  1671. printk("cfg base address index = %xn", cfg_base_addr_index);
  1672. #endif /* CCISS_DEBUG */
  1674. cfg_offset = readl(c->vaddr + SA5_CTMEM_OFFSET);
  1675. #ifdef CCISS_DEBUG
  1676. printk("cfg offset = %xn", cfg_offset);
  1677. #endif /* CCISS_DEBUG */
  1678. c->cfgtable = (CfgTable_struct *) 
  1679. remap_pci_mem((addr[cfg_base_addr_index] & 0xfffffff0)
  1680. + cfg_offset, sizeof(CfgTable_struct));
  1681. c->board_id = board_id;
  1683. #ifdef CCISS_DEBUG
  1684. print_cfg_table(c->cfgtable); 
  1685. #endif /* CCISS_DEBUG */
  1687. for(i=0; i<NR_PRODUCTS; i++) {
  1688. if (board_id == products[i].board_id) {
  1689. c->product_name = products[i].product_name;
  1690. c->access = *(products[i].access);
  1691. break;
  1692. }
  1693. }
  1694. if (i == NR_PRODUCTS) {
  1695. printk(KERN_WARNING "cciss: Sorry, I don't know how"
  1696. " to access the Smart Array controller %08lxn", 
  1697. (unsigned long)board_id);
  1698. return -1;
  1699. }
  1700. if (  (readb(&c->cfgtable->Signature[0]) != 'C') ||
  1701.       (readb(&c->cfgtable->Signature[1]) != 'I') ||
  1702.       (readb(&c->cfgtable->Signature[2]) != 'S') ||
  1703.       (readb(&c->cfgtable->Signature[3]) != 'S') )
  1704. {
  1705. printk("Does not appear to be a valid CISS config tablen");
  1706. return -1;
  1707. }
  1708. #ifdef CCISS_DEBUG
  1709. printk("Trying to put board into Simple moden");
  1710. #endif /* CCISS_DEBUG */ 
  1711. c->max_commands = readl(&(c->cfgtable->CmdsOutMax));
  1712. /* Update the field, and then ring the doorbell */ 
  1713. writel( CFGTBL_Trans_Simple, 
  1714. &(c->cfgtable->HostWrite.TransportRequest));
  1715. writel( CFGTBL_ChangeReq, c->vaddr + SA5_DOORBELL);
  1717. for(i=0;i<MAX_CONFIG_WAIT;i++)
  1718. {
  1719. if (!(readl(c->vaddr + SA5_DOORBELL) & CFGTBL_ChangeReq))
  1720. break;
  1721. /* delay and try again */
  1722. udelay(1000);
  1723. }
  1725. #ifdef CCISS_DEBUG
  1726. printk(KERN_DEBUG "I counter got to %d %xn", i, readl(c->vaddr + SA5_DOORBELL));
  1727. #endif /* CCISS_DEBUG */
  1728. #ifdef CCISS_DEBUG
  1729. print_cfg_table(c->cfgtable);
  1730. #endif /* CCISS_DEBUG */ 
  1732. if (!(readl(&(c->cfgtable->TransportActive)) & CFGTBL_Trans_Simple))
  1733. {
  1734. printk(KERN_WARNING "cciss: unable to get board into"
  1735. " simple moden");
  1736. return -1;
  1737. }
  1738. return 0;
  1740. }
  1742. /* 
  1743.  * Gets information about the local volumes attached to the controller. 
  1744.  */ 
  1745. static void cciss_getgeometry(int cntl_num)
  1746. {
  1747. ReportLunData_struct *ld_buff;
  1748. ReadCapdata_struct *size_buff;
  1749. InquiryData_struct *inq_buff;
  1750. int return_code;
  1751. int i;
  1752. int listlength = 0;
  1753. __u32 lunid = 0;
  1754. int block_size;
  1755. int total_size; 
  1757. ld_buff = kmalloc(sizeof(ReportLunData_struct), GFP_KERNEL);
  1758. if (ld_buff == NULL)
  1759. {
  1760. printk(KERN_ERR "cciss: out of memoryn");
  1761. return;
  1762. }
  1763. memset(ld_buff, 0, sizeof(ReportLunData_struct));
  1764. size_buff = kmalloc(sizeof( ReadCapdata_struct), GFP_KERNEL);
  1765.         if (size_buff == NULL)
  1766.         {
  1767.                 printk(KERN_ERR "cciss: out of memoryn");
  1768. kfree(ld_buff);
  1769.                 return;
  1770.         }
  1771. inq_buff = kmalloc(sizeof( InquiryData_struct), GFP_KERNEL);
  1772.         if (inq_buff == NULL)
  1773.         {
  1774.                 printk(KERN_ERR "cciss: out of memoryn");
  1775.                 kfree(ld_buff);
  1776. kfree(size_buff);
  1777.                 return;
  1778.         }
  1779. /* Get the firmware version */ 
  1780. return_code = sendcmd(CISS_INQUIRY, cntl_num, inq_buff, 
  1781. sizeof(InquiryData_struct), 0, 0 ,0, NULL);
  1782. if (return_code == IO_OK)
  1783. {
  1784. hba[cntl_num]->firm_ver[0] = inq_buff->data_byte[32];
  1785. hba[cntl_num]->firm_ver[1] = inq_buff->data_byte[33];
  1786. hba[cntl_num]->firm_ver[2] = inq_buff->data_byte[34];
  1787. hba[cntl_num]->firm_ver[3] = inq_buff->data_byte[35];
  1788. } else /* send command failed */
  1789. {
  1790. printk(KERN_WARNING "cciss: unable to determine firmware"
  1791. " version of controllern");
  1792. }
  1793. /* Get the number of logical volumes */ 
  1794. return_code = sendcmd(CISS_REPORT_LOG, cntl_num, ld_buff, 
  1795. sizeof(ReportLunData_struct), 0, 0, 0, NULL);
  1797. if( return_code == IO_OK)
  1798. {
  1799. #ifdef CCISS_DEBUG
  1800. printk("LUN Datan--------------------------n");
  1801. #endif /* CCISS_DEBUG */ 
  1803. listlength |= (0xff & (unsigned int)(ld_buff->LUNListLength[0])) << 24;
  1804. listlength |= (0xff & (unsigned int)(ld_buff->LUNListLength[1])) << 16;
  1805. listlength |= (0xff & (unsigned int)(ld_buff->LUNListLength[2])) << 8;
  1806. listlength |= 0xff & (unsigned int)(ld_buff->LUNListLength[3]);
  1807. } else /* reading number of logical volumes failed */
  1808. {
  1809. printk(KERN_WARNING "cciss: report logical volume"
  1810. " command failedn");
  1811. listlength = 0;
  1812. }
  1813. hba[cntl_num]->num_luns = listlength / 8; // 8 bytes pre entry
  1814. if (hba[cntl_num]->num_luns > CISS_MAX_LUN)
  1815. {
  1816. printk(KERN_ERR "ciss:  only %d number of logical volumes supportedn",
  1817. CISS_MAX_LUN);
  1818. hba[cntl_num]->num_luns = CISS_MAX_LUN;
  1819. }
  1820. #ifdef CCISS_DEBUG
  1821. printk(KERN_DEBUG "Length = %x %x %x %x = %dn", ld_buff->LUNListLength[0],
  1822. ld_buff->LUNListLength[1], ld_buff->LUNListLength[2],
  1823. ld_buff->LUNListLength[3],  hba[cntl_num]->num_luns);
  1824. #endif /* CCISS_DEBUG */
  1825. for(i=0; i<  hba[cntl_num]->num_luns ; i++)
  1826. {
  1827.    lunid = (0xff & (unsigned int)(ld_buff->LUN[i][3])) << 24;
  1828.          lunid |= (0xff & (unsigned int)(ld_buff->LUN[i][2])) << 16;
  1829.          lunid |= (0xff & (unsigned int)(ld_buff->LUN[i][1])) << 8;
  1830.          lunid |= 0xff & (unsigned int)(ld_buff->LUN[i][0]);
  1831. hba[cntl_num]->drv[i].LunID = lunid;
  1833. #ifdef CCISS_DEBUG
  1834.    printk(KERN_DEBUG "LUN[%d]:  %x %x %x %x = %xn", i, 
  1835. ld_buff->LUN[i][0], ld_buff->LUN[i][1],ld_buff->LUN[i][2], 
  1836. ld_buff->LUN[i][3], hba[cntl_num]->drv[i].LunID);
  1837. #endif /* CCISS_DEBUG */
  1839.    memset(size_buff, 0, sizeof(ReadCapdata_struct));
  1840.    return_code = sendcmd(CCISS_READ_CAPACITY, cntl_num, size_buff, 
  1841. sizeof( ReadCapdata_struct), 1, i, 0, NULL);
  1842.    if (return_code == IO_OK)
  1843. {
  1844. total_size = (0xff & 
  1845. (unsigned int)(size_buff->total_size[0])) << 24;
  1846. total_size |= (0xff & 
  1847. (unsigned int)(size_buff->total_size[1])) << 16;
  1848. total_size |= (0xff & 
  1849. (unsigned int)(size_buff->total_size[2])) << 8;
  1850. total_size |= (0xff & (unsigned int)
  1851. (size_buff->total_size[3])); 
  1852. total_size++; // command returns highest block address
  1854. block_size = (0xff & 
  1855. (unsigned int)(size_buff->block_size[0])) << 24;
  1856.                  block_size |= (0xff & 
  1857. (unsigned int)(size_buff->block_size[1])) << 16;
  1858.                  block_size |= (0xff & 
  1859. (unsigned int)(size_buff->block_size[2])) << 8;
  1860.                  block_size |= (0xff & 
  1861. (unsigned int)(size_buff->block_size[3]));
  1862. } else /* read capacity command failed */ 
  1863. {
  1864. printk(KERN_WARNING "cciss: read capacity failedn");
  1865. total_size = block_size = 0; 
  1866. }
  1867. printk(KERN_INFO "      blocks= %d block_size= %dn", 
  1868. total_size, block_size);
  1870. /* Execute the command to read the disk geometry */
  1871. memset(inq_buff, 0, sizeof(InquiryData_struct));
  1872. return_code = sendcmd(CISS_INQUIRY, cntl_num, inq_buff,
  1873. sizeof(InquiryData_struct), 1, i, 0xC1, NULL );
  1874.    if (return_code == IO_OK)
  1875. {
  1876. if(inq_buff->data_byte[8] == 0xFF)
  1877. {
  1878.    printk(KERN_WARNING "cciss: reading geometry failed, volume does not support reading geometryn");
  1880.                            hba[cntl_num]->drv[i].block_size = block_size;
  1881.                            hba[cntl_num]->drv[i].nr_blocks = total_size;
  1882.                            hba[cntl_num]->drv[i].heads = 255;
  1883.                            hba[cntl_num]->drv[i].sectors = 32; // Sectors per track
  1884.                            hba[cntl_num]->drv[i].cylinders = total_size / 255 / 32;                 } else
  1885. {
  1887.      hba[cntl_num]->drv[i].block_size = block_size;
  1888.                            hba[cntl_num]->drv[i].nr_blocks = total_size;
  1889.                            hba[cntl_num]->drv[i].heads = 
  1890. inq_buff->data_byte[6]; 
  1891.                            hba[cntl_num]->drv[i].sectors = 
  1892. inq_buff->data_byte[7]; 
  1893.    hba[cntl_num]->drv[i].cylinders = 
  1894. (inq_buff->data_byte[4] & 0xff) << 8;
  1895.    hba[cntl_num]->drv[i].cylinders += 
  1896.                                         inq_buff->data_byte[5];
  1897. }
  1898. }
  1899. else /* Get geometry failed */
  1900. {
  1901. printk(KERN_WARNING "cciss: reading geometry failed, continuing with default geometryn"); 
  1903. hba[cntl_num]->drv[i].block_size = block_size;
  1904. hba[cntl_num]->drv[i].nr_blocks = total_size;
  1905. hba[cntl_num]->drv[i].heads = 255;
  1906. hba[cntl_num]->drv[i].sectors = 32; // Sectors per track 
  1907. hba[cntl_num]->drv[i].cylinders = total_size / 255 / 32;
  1908. }
  1909. printk(KERN_INFO "      heads= %d, sectors= %d, cylinders= %dnn",
  1910. hba[cntl_num]->drv[i].heads, 
  1911. hba[cntl_num]->drv[i].sectors,
  1912. hba[cntl_num]->drv[i].cylinders);
  1914. }
  1915. kfree(ld_buff);
  1916. kfree(size_buff);
  1917. kfree(inq_buff);
  1918. }
  1920. /* Function to find the first free pointer into our hba[] array */
  1921. /* Returns -1 if no free entries are left.  */
  1922. static int alloc_cciss_hba(void)
  1923. {
  1924. int i;
  1925. for(i=0; i< MAX_CTLR; i++)
  1926. {
  1927. if (hba[i] == NULL)
  1928. {
  1929. hba[i] = kmalloc(sizeof(ctlr_info_t), GFP_KERNEL);
  1930. if(hba[i]==NULL)
  1931. {
  1932. printk(KERN_ERR "cciss: out of memory.n");
  1933. return (-1);
  1934. }
  1935. return (i);
  1936. }
  1937. }
  1938. printk(KERN_WARNING "cciss: This driver supports a maximum"
  1939. " of 8 controllers.n");
  1940. return(-1);
  1941. }
  1943. static void free_hba(int i)
  1944. {
  1945. kfree(hba[i]);
  1946. hba[i]=NULL;
  1947. }
  1949. /*
  1950.  *  This is it.  Find all the controllers and register them.  I really hate
  1951.  *  stealing all these major device numbers.
  1952.  *  returns the number of block devices registered.
  1953.  */
  1954. static int __init cciss_init_one(struct pci_dev *pdev,
  1955. const struct pci_device_id *ent)
  1956. {
  1957. request_queue_t *q;
  1958. int i;
  1959. int j;
  1961. printk(KERN_DEBUG "cciss: Device 0x%x has been found at"
  1962. " bus %d dev %d func %dn",
  1963. pdev->device, pdev->bus->number, PCI_SLOT(pdev->devfn),
  1964. PCI_FUNC(pdev->devfn));
  1965. i = alloc_cciss_hba();
  1966. if( i < 0 ) 
  1967. return (-1);
  1968. memset(hba[i], 0, sizeof(ctlr_info_t));
  1969. if (cciss_pci_init(hba[i], pdev) != 0)
  1970. {
  1971. free_hba(i);
  1972. return (-1);
  1973. }
  1974. sprintf(hba[i]->devname, "cciss%d", i);
  1975. hba[i]->ctlr = i;
  1976. hba[i]->pdev = pdev;
  1978. /* configure PCI DMA stuff */
  1979. if (!pci_set_dma_mask(pdev, (u64) 0xffffffffffffffff))
  1980. printk("cciss: using DAC cyclesn");
  1981. else if (!pci_set_dma_mask(pdev, (u64) 0xffffffff))
  1982. printk("cciss: not using DAC cyclesn");
  1983. else {
  1984. printk("cciss: no suitable DMA availablen");
  1985. free_hba(i);
  1986. return -ENODEV;
  1987. }
  1989. if( register_blkdev(MAJOR_NR+i, hba[i]->devname, &cciss_fops))
  1990. {
  1991. printk(KERN_ERR "cciss:  Unable to get major number "
  1992. "%d for %sn", MAJOR_NR+i, hba[i]->devname);
  1993. release_io_mem(hba[i]);
  1994. free_hba(i);
  1995. return(-1);
  1996. }
  1997. /* make sure the board interrupts are off */
  1998. hba[i]->access.set_intr_mask(hba[i], CCISS_INTR_OFF);
  1999. if( request_irq(hba[i]->intr, do_cciss_intr, 
  2000. SA_INTERRUPT | SA_SHIRQ | SA_SAMPLE_RANDOM, 
  2001. hba[i]->devname, hba[i]))
  2002. {
  2003. printk(KERN_ERR "ciss: Unable to get irq %d for %sn",
  2004. hba[i]->intr, hba[i]->devname);
  2005. unregister_blkdev( MAJOR_NR+i, hba[i]->devname);
  2006. release_io_mem(hba[i]);
  2007. free_hba(i);
  2008. return(-1);
  2009. }
  2010. hba[i]->cmd_pool_bits = (__u32*)kmalloc(
  2011.          ((NR_CMDS+31)/32)*sizeof(__u32), GFP_KERNEL);
  2012. hba[i]->cmd_pool = (CommandList_struct *)pci_alloc_consistent(
  2013. hba[i]->pdev, NR_CMDS * sizeof(CommandList_struct), 
  2014. &(hba[i]->cmd_pool_dhandle));
  2015. hba[i]->errinfo_pool = (ErrorInfo_struct *)pci_alloc_consistent(
  2016. hba[i]->pdev, NR_CMDS * sizeof( ErrorInfo_struct), 
  2017. &(hba[i]->errinfo_pool_dhandle));
  2018. if((hba[i]->cmd_pool_bits == NULL) 
  2019. || (hba[i]->cmd_pool == NULL)
  2020. || (hba[i]->errinfo_pool == NULL))
  2021.         {
  2022. if(hba[i]->cmd_pool_bits)
  2023.                  kfree(hba[i]->cmd_pool_bits);
  2024.                 if(hba[i]->cmd_pool)
  2025.                  pci_free_consistent(hba[i]->pdev,  
  2026. NR_CMDS * sizeof(CommandList_struct), 
  2027. hba[i]->cmd_pool, hba[i]->cmd_pool_dhandle);
  2028. if(hba[i]->errinfo_pool)
  2029. pci_free_consistent(hba[i]->pdev,
  2030. NR_CMDS * sizeof( ErrorInfo_struct),
  2031. hba[i]->errinfo_pool, 
  2032. hba[i]->errinfo_pool_dhandle);
  2033.                 free_irq(hba[i]->intr, hba[i]);
  2034.                 unregister_blkdev(MAJOR_NR+i, hba[i]->devname);
  2035. release_io_mem(hba[i]);
  2036. free_hba(i);
  2037.                 printk( KERN_ERR "cciss: out of memory");
  2038. return(-1);
  2039. }
  2041. /* Initialize the pdev driver private data. 
  2042. have it point to hba[i].  */
  2043. pci_set_drvdata(pdev, hba[i]);
  2044. /* command and error info recs zeroed out before 
  2045. they are used */
  2046.         memset(hba[i]->cmd_pool_bits, 0, ((NR_CMDS+31)/32)*sizeof(__u32));
  2048. #ifdef CCISS_DEBUG
  2049. printk(KERN_DEBUG "Scanning for drives on controller cciss%dn",i);
  2050. #endif /* CCISS_DEBUG */
  2052. cciss_getgeometry(i);
  2054. cciss_find_non_disk_devices(i); /* find our tape drives, if any */
  2056. /* Turn the interrupts on so we can service requests */
  2057. hba[i]->access.set_intr_mask(hba[i], CCISS_INTR_ON);
  2059. cciss_procinit(i);
  2061. q = BLK_DEFAULT_QUEUE(MAJOR_NR + i);
  2062. q->queuedata = hba[i];
  2063. blk_init_queue(q, do_cciss_request);
  2064. blk_queue_bounce_limit(q, hba[i]->pdev->dma_mask);
  2065. blk_queue_headactive(q, 0);
  2067. /* fill in the other Kernel structs */
  2068. blksize_size[MAJOR_NR+i] = hba[i]->blocksizes;
  2069.         hardsect_size[MAJOR_NR+i] = hba[i]->hardsizes;
  2070.         read_ahead[MAJOR_NR+i] = READ_AHEAD;
  2072. /* Set the pointers to queue functions */ 
  2073. q->back_merge_fn = cpq_back_merge_fn;
  2074.         q->front_merge_fn = cpq_front_merge_fn;
  2075.         q->merge_requests_fn = cpq_merge_requests_fn;
  2078. /* Fill in the gendisk data */ 
  2079. hba[i]->gendisk.major = MAJOR_NR + i;
  2080. hba[i]->gendisk.major_name = "cciss";
  2081. hba[i]->gendisk.minor_shift = NWD_SHIFT;
  2082. hba[i]->gendisk.max_p = MAX_PART;
  2083. hba[i]->gendisk.part = hba[i]->hd;
  2084. hba[i]->gendisk.sizes = hba[i]->sizes;
  2085. hba[i]->gendisk.nr_real = hba[i]->num_luns;
  2087. /* Get on the disk list */ 
  2088. add_gendisk(&(hba[i]->gendisk));
  2090. cciss_geninit(i);
  2091. for(j=0; j<NWD; j++)
  2092. register_disk(&(hba[i]->gendisk),
  2093. MKDEV(MAJOR_NR+i, j <<4), 
  2094. MAX_PART, &cciss_fops, 
  2095. hba[i]->drv[j].nr_blocks);
  2097. cciss_register_scsi(i, 1);  /* hook ourself into SCSI subsystem */
  2099. return(1);
  2100. }
  2102. static void __devexit cciss_remove_one (struct pci_dev *pdev)
  2103. {
  2104. ctlr_info_t *tmp_ptr;
  2105. int i;
  2106. char flush_buf[4];
  2107. int return_code; 
  2109. if (pci_get_drvdata(pdev) == NULL)
  2110. {
  2111. printk( KERN_ERR "cciss: Unable to remove device n");
  2112. return;
  2113. }
  2114. tmp_ptr = pci_get_drvdata(pdev);
  2115. i = tmp_ptr->ctlr;
  2116. if (hba[i] == NULL) 
  2117. {
  2118. printk(KERN_ERR "cciss: device appears to "
  2119. "already be removed n");
  2120. return;
  2121. }
  2122.   /* Turn board interrupts off  and send the flush cache command */
  2123.   /* sendcmd will turn off interrupt, and send the flush...
  2124.    * To write all data in the battery backed cache to disks */
  2125.   memset(flush_buf, 0, 4);
  2126.   return_code = sendcmd(CCISS_CACHE_FLUSH, i, flush_buf, 4,0,0,0, NULL);
  2127.   if (return_code != IO_OK) {
  2128.   printk(KERN_WARNING 
  2129. "Error Flushing cache on controller %dn", i);
  2130.   }
  2131. free_irq(hba[i]->intr, hba[i]);
  2132. pci_set_drvdata(pdev, NULL);
  2133. iounmap((void*)hba[i]->vaddr);
  2134. cciss_unregister_scsi(i);  /* unhook from SCSI subsystem */
  2135. unregister_blkdev(MAJOR_NR+i, hba[i]->devname);
  2136. remove_proc_entry(hba[i]->devname, proc_cciss);
  2139. /* remove it from the disk list */
  2140. del_gendisk(&(hba[i]->gendisk));
  2142. pci_free_consistent(hba[i]->pdev, NR_CMDS * sizeof(CommandList_struct), 
  2143. hba[i]->cmd_pool, hba[i]->cmd_pool_dhandle);
  2144. pci_free_consistent(hba[i]->pdev, NR_CMDS * sizeof( ErrorInfo_struct),
  2145. hba[i]->errinfo_pool, hba[i]->errinfo_pool_dhandle);
  2146. kfree(hba[i]->cmd_pool_bits);
  2147. release_io_mem(hba[i]);
  2148. free_hba(i);
  2149. }
  2151. static struct pci_driver cciss_pci_driver = {
  2152.  name:   "cciss",
  2153. probe:  cciss_init_one,
  2154. remove:  __devexit_p(cciss_remove_one),
  2155. id_table:  cciss_pci_device_id, /* id_table */
  2156. };
  2158. /*
  2159. *  This is it.  Register the PCI driver information for the cards we control
  2160. *  the OS will call our registered routines when it finds one of our cards. 
  2161. */
  2162. int __init cciss_init(void)
  2163. {
  2165. printk(KERN_INFO DRIVER_NAME "n");
  2166. /* Register for out PCI devices */
  2167. if (pci_register_driver(&cciss_pci_driver) > 0 )
  2168. return 0;
  2169. else 
  2170. return -ENODEV;
  2172.  }
  2174. EXPORT_NO_SYMBOLS;
  2175. static int __init init_cciss_module(void)
  2176. {
  2178. return ( cciss_init());
  2179. }
  2181. static void __exit cleanup_cciss_module(void)
  2182. {
  2183. int i;
  2185. pci_unregister_driver(&cciss_pci_driver);
  2186. /* double check that all controller entrys have been removed */
  2187. for (i=0; i< MAX_CTLR; i++) 
  2188. {
  2189. if (hba[i] != NULL)
  2190. {
  2191. printk(KERN_WARNING "cciss: had to remove"
  2192. " controller %dn", i);
  2193. cciss_remove_one(hba[i]->pdev);
  2194. }
  2195. }
  2196. remove_proc_entry("cciss", proc_root_driver);
  2197. }
  2199. module_init(init_cciss_module);
  2200. module_exit(cleanup_cciss_module);