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

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

Linux/Unix编程

开发平台：

Unix_Linux

cpqarray.c：源码内容
  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 arrays@compaq.com
  20.  *
  21.  */
  22. #include <linux/config.h> /* CONFIG_PROC_FS */
  23. #include <linux/module.h>
  24. #include <linux/version.h>
  25. #include <linux/types.h>
  26. #include <linux/pci.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 <asm/uaccess.h>
  39. #include <asm/io.h>
  42. #define SMART2_DRIVER_VERSION(maj,min,submin) ((maj<<16)|(min<<8)|(submin))
  44. #define DRIVER_NAME "Compaq SMART2 Driver (v 2.4.21)"
  45. #define DRIVER_VERSION SMART2_DRIVER_VERSION(2,4,21)
  47. /* Embedded module documentation macros - see modules.h */
  48. /* Original author Chris Frantz - Compaq Computer Corporation */
  49. MODULE_AUTHOR("Compaq Computer Corporation");
  50. MODULE_DESCRIPTION("Driver for Compaq Smart2 Array Controllers version 2.4.21");
  51. MODULE_LICENSE("GPL");
  53. #define MAJOR_NR COMPAQ_SMART2_MAJOR
  54. #include <linux/blk.h>
  55. #include <linux/blkdev.h>
  56. #include <linux/genhd.h>
  58. #include "cpqarray.h"
  59. #include "ida_cmd.h"
  60. #include "smart1,2.h"
  61. #include "ida_ioctl.h"
  63. #define READ_AHEAD 128
  64. #define NR_CMDS 128 /* This could probably go as high as ~400 */
  66. #define MAX_CTLR 8
  68. #define CPQARRAY_DMA_MASK 0xFFFFFFFF /* 32 bit DMA */
  70. static ctlr_info_t *hba[MAX_CTLR] = 
  71. { NULL, NULL, NULL, NULL, NULL, NULL, NULL, NULL };
  73. static int eisa[8];
  75. #define NR_PRODUCTS (sizeof(products)/sizeof(struct board_type))
  77. /*  board_id = Subsystem Device ID & Vendor ID
  78.  *  product = Marketing Name for the board
  79.  *  access = Address of the struct of function pointers 
  80.  */
  81. static struct board_type products[] = {
  82. { 0x0040110E, "IDA", &smart1_access },
  83. { 0x0140110E, "IDA-2", &smart1_access },
  84. { 0x1040110E, "IAES", &smart1_access },
  85. { 0x2040110E, "SMART", &smart1_access },
  86. { 0x3040110E, "SMART-2/E", &smart2e_access },
  87. { 0x40300E11, "SMART-2/P", &smart2_access },
  88. { 0x40310E11, "SMART-2SL", &smart2_access },
  89. { 0x40320E11, "Smart Array 3200", &smart2_access },
  90. { 0x40330E11, "Smart Array 3100ES", &smart2_access },
  91. { 0x40340E11, "Smart Array 221", &smart2_access },
  92. { 0x40400E11, "Integrated Array", &smart4_access },
  93. { 0x40480E11, "Compaq Raid LC2",        &smart4_access },
  94. { 0x40500E11, "Smart Array 4200", &smart4_access },
  95. { 0x40510E11, "Smart Array 4250ES", &smart4_access },
  96. { 0x40580E11, "Smart Array 431", &smart4_access },
  97. };
  99. /* define the PCI info for the PCI cards this driver can control */
  100. const struct pci_device_id cpqarray_pci_device_id[] = 
  101. {
  102. { PCI_VENDOR_ID_DEC, PCI_DEVICE_ID_COMPAQ_42XX, 
  103. 0x0E11, 0x4058, 0, 0, 0}, /* SA431 */
  104. { PCI_VENDOR_ID_DEC, PCI_DEVICE_ID_COMPAQ_42XX, 
  105.                 0x0E11, 0x4051, 0, 0, 0}, /* SA4250ES */
  106. { PCI_VENDOR_ID_DEC, PCI_DEVICE_ID_COMPAQ_42XX, 
  107.                 0x0E11, 0x4050, 0, 0, 0}, /* SA4200 */
  108. { PCI_VENDOR_ID_NCR, PCI_DEVICE_ID_NCR_53C1510,
  109. 0x0E11, 0x4048, 0, 0, 0}, /* LC2 */
  110. { PCI_VENDOR_ID_NCR, PCI_DEVICE_ID_NCR_53C1510,
  111.                 0x0E11, 0x4040, 0, 0, 0},  /* Integrated Array */
  112. { PCI_VENDOR_ID_COMPAQ, PCI_DEVICE_ID_COMPAQ_SMART2P, 
  113. 0x0E11, 0x4034, 0, 0, 0}, /* SA 221 */ 
  114. { PCI_VENDOR_ID_COMPAQ, PCI_DEVICE_ID_COMPAQ_SMART2P, 
  115.                 0x0E11, 0x4033, 0, 0, 0},       /* SA 3100ES*/
  116. { PCI_VENDOR_ID_COMPAQ, PCI_DEVICE_ID_COMPAQ_SMART2P, 
  117.                 0x0E11, 0x4032, 0, 0, 0},       /* SA 3200*/
  118. { PCI_VENDOR_ID_COMPAQ, PCI_DEVICE_ID_COMPAQ_SMART2P, 
  119.                 0x0E11, 0x4031, 0, 0, 0},       /* SA 2SL*/
  120. { PCI_VENDOR_ID_COMPAQ, PCI_DEVICE_ID_COMPAQ_SMART2P, 
  121.                 0x0E11, 0x4030, 0, 0, 0},       /* SA 2P */
  122. { 0 }
  123. };
  125. MODULE_DEVICE_TABLE(pci, cpqarray_pci_device_id);
  127. static struct proc_dir_entry *proc_array;
  129. /* Debug... */
  130. #define DBG(s) do { s } while(0)
  131. /* Debug (general info)... */
  132. #define DBGINFO(s) do { } while(0)
  133. /* Debug Paranoid... */
  134. #define DBGP(s)  do { } while(0)
  135. /* Debug Extra Paranoid... */
  136. #define DBGPX(s) do { } while(0)
  138. int cpqarray_init(void);
  139. static int cpqarray_pci_init(ctlr_info_t *c, struct pci_dev *pdev);
  140. static void *remap_pci_mem(ulong base, ulong size);
  141. static int cpqarray_eisa_detect(void);
  142. static int pollcomplete(int ctlr);
  143. static void getgeometry(int ctlr);
  144. static void start_fwbk(int ctlr);
  146. static cmdlist_t * cmd_alloc(ctlr_info_t *h, int get_from_pool);
  147. static void cmd_free(ctlr_info_t *h, cmdlist_t *c, int got_from_pool);
  149. static void free_hba(int i);
  150. static int alloc_cpqarray_hba(void);
  152. static int sendcmd(
  153. __u8 cmd,
  154. int ctlr,
  155. void *buff,
  156. size_t size,
  157. unsigned int blk,
  158. unsigned int blkcnt,
  159. unsigned int log_unit );
  161. static int ida_open(struct inode *inode, struct file *filep);
  162. static int ida_release(struct inode *inode, struct file *filep);
  163. static int ida_ioctl(struct inode *inode, struct file *filep, unsigned int cmd, unsigned long arg);
  164. static int ida_ctlr_ioctl(int ctlr, int dsk, ida_ioctl_t *io);
  166. static void do_ida_request(request_queue_t *q);
  167. static void start_io(ctlr_info_t *h);
  169. static inline void addQ(cmdlist_t **Qptr, cmdlist_t *c);
  170. static inline cmdlist_t *removeQ(cmdlist_t **Qptr, cmdlist_t *c);
  171. static inline void complete_buffers(struct buffer_head *bh, int ok);
  172. static inline void complete_command(cmdlist_t *cmd, int timeout);
  174. static void do_ida_intr(int irq, void *dev_id, struct pt_regs * regs);
  175. static void ida_timer(unsigned long tdata);
  176. static int frevalidate_logvol(kdev_t dev);
  177. static int revalidate_logvol(kdev_t dev, int maxusage);
  178. static int revalidate_allvol(kdev_t dev);
  180. static int deregister_disk(int ctlr, int logvol);
  181. static int register_new_disk(int cltr,int logvol);
  183. #ifdef CONFIG_PROC_FS
  184. static void ida_procinit(int i);
  185. static int ida_proc_get_info(char *buffer, char **start, off_t offset, int length, int *eof, void *data);
  186. #else
  187. static void ida_procinit(int i) {}
  188. static int ida_proc_get_info(char *buffer, char **start, off_t offset,
  189.      int length, int *eof, void *data) { return 0;}
  190. #endif
  192. static void ida_geninit(int ctlr)
  193. {
  194. int i,j;
  195. drv_info_t *drv;
  197. for(i=0; i<NWD; i++) {
  198. drv = &hba[ctlr]->drv[i];
  199. if (!drv->nr_blks)
  200. continue;
  201. hba[ctlr]->hd[i<<NWD_SHIFT].nr_sects =
  202. hba[ctlr]->sizes[i<<NWD_SHIFT] = drv->nr_blks;
  204. for(j=0; j<IDA_MAX_PART; j++) {
  205. hba[ctlr]->blocksizes[(i<<NWD_SHIFT)+j] = 1024;
  206. hba[ctlr]->hardsizes[(i<<NWD_SHIFT)+j] = drv->blk_size;
  207. }
  208. }
  209. hba[ctlr]->gendisk.nr_real = hba[ctlr]->highest_lun +1;
  211. }
  213. static struct block_device_operations ida_fops  = {
  214. owner: THIS_MODULE,
  215. open: ida_open,
  216. release: ida_release,
  217. ioctl: ida_ioctl,
  218. revalidate: frevalidate_logvol,
  219. };
  222. #ifdef CONFIG_PROC_FS
  224. /*
  225.  * Get us a file in /proc/array that says something about each controller.
  226.  * Create /proc/array if it doesn't exist yet.
  227.  */
  228. static void __init ida_procinit(int i)
  229. {
  230. if (proc_array == NULL) {
  231. proc_array = proc_mkdir("cpqarray", proc_root_driver);
  232. if (!proc_array) return;
  233. }
  235. create_proc_read_entry(hba[i]->devname, 0, proc_array,
  236.        ida_proc_get_info, hba[i]);
  237. }
  239. /*
  240.  * Report information about this controller.
  241.  */
  242. static int ida_proc_get_info(char *buffer, char **start, off_t offset, int length, int *eof, void *data)
  243. {
  244. off_t pos = 0;
  245. off_t len = 0;
  246. int size, i, ctlr;
  247. ctlr_info_t *h = (ctlr_info_t*)data;
  248. drv_info_t *drv;
  249. #ifdef CPQ_PROC_PRINT_QUEUES
  250. cmdlist_t *c;
  251. #endif
  253. ctlr = h->ctlr;
  254. size = sprintf(buffer, "%s:  Compaq %s Controllern"
  255. "       Board ID: 0x%08lxn"
  256. "       Firmware Revision: %c%c%c%cn"
  257. "       Controller Sig: 0x%08lxn"
  258. "       Memory Address: 0x%08lxn"
  259. "       I/O Port: 0x%04xn"
  260. "       IRQ: %dn"
  261. "       Logical drives: %dn"
  262. "       Highest Logical ID: %dn"
  263. "       Physical drives: %dnn"
  264. "       Current Q depth: %dn"
  265. "       Max Q depth since init: %dnn",
  266. h->devname, 
  267. h->product_name,
  268. (unsigned long)h->board_id,
  269. h->firm_rev[0], h->firm_rev[1], h->firm_rev[2], h->firm_rev[3],
  270. (unsigned long)h->ctlr_sig, (unsigned long)h->vaddr,
  271. (unsigned int) h->io_mem_addr, (unsigned int)h->intr,
  272. h->log_drives, h->highest_lun, h->phys_drives,
  273. h->Qdepth, h->maxQsinceinit);
  275. pos += size; len += size;
  277. size = sprintf(buffer+len, "Logical Drive Info:n");
  278. pos += size; len += size;
  280. for(i=0; i<=h->highest_lun; i++) {
  281. drv = &h->drv[i];
  282. if(drv->nr_blks != 0)
  283. {
  284.      size = sprintf(buffer+len, "ida/c%dd%d: blksz=%d nr_blks=%dn",
  285. ctlr, i, drv->blk_size, drv->nr_blks);
  286. pos += size; len += size;
  287. }
  288. }
  290. #ifdef CPQ_PROC_PRINT_QUEUES
  291. size = sprintf(buffer+len, "nCurrent Queues:n");
  292. pos += size; len += size;
  294. c = h->reqQ;
  295. size = sprintf(buffer+len, "reqQ = %p", c); pos += size; len += size;
  296. if (c) c=c->next;
  297. while(c && c != h->reqQ) {
  298. size = sprintf(buffer+len, "->%p", c);
  299. pos += size; len += size;
  300. c=c->next;
  301. }
  303. c = h->cmpQ;
  304. size = sprintf(buffer+len, "ncmpQ = %p", c); pos += size; len += size;
  305. if (c) c=c->next;
  306. while(c && c != h->cmpQ) {
  307. size = sprintf(buffer+len, "->%p", c);
  308. pos += size; len += size;
  309. c=c->next;
  310. }
  312. size = sprintf(buffer+len, "n"); pos += size; len += size;
  313. #endif
  314. size = sprintf(buffer+len, "nr_allocs = %dnnr_frees = %dn",
  315. h->nr_allocs, h->nr_frees);
  316. pos += size; len += size;
  318. *eof = 1;
  319. *start = buffer+offset;
  320. len -= offset;
  321. if (len>length)
  322. len = length;
  323. return len;
  324. }
  325. #endif /* CONFIG_PROC_FS */
  328. MODULE_PARM(eisa, "1-8i");
  329. EXPORT_NO_SYMBOLS;
  331. /* This is a bit of a hack... */
  332. int __init init_cpqarray_module(void)
  333. {
  334. if (cpqarray_init() == 0) /* all the block dev numbers already used */
  335. return -ENODEV;   /* or no controllers were found */
  336. return 0;
  337. }
  339. static void release_io_mem(ctlr_info_t *c)
  340. {
  341. /* if IO mem was not protected do nothing */
  342. if( c->io_mem_addr == 0)
  343. return;
  344. release_region(c->io_mem_addr, c->io_mem_length);
  345. c->io_mem_addr = 0;
  346. c->io_mem_length = 0;
  347. }
  349. static void __devexit cpqarray_remove_one (struct pci_dev *pdev)
  350. {
  351. int i;
  352. ctlr_info_t *tmp_ptr;
  353. char buff[4]; 
  355. if (pdev->driver_data == NULL)
  356. {
  357. printk( KERN_ERR "cpqarray: Unable to remove device n");
  358. return;
  359. }
  360. tmp_ptr = (ctlr_info_t *) pdev->driver_data;
  361. i = tmp_ptr->ctlr;
  362. if (hba[i] == NULL) 
  363. {
  364. printk(KERN_ERR "cpqarray: device appears to "
  365. "already be removed n");
  366. return;
  367. }
  369. /* sendcmd will turn off interrupt, and send the flush... 
  370.  * To write all data in the battery backed cache to disks    */
  371. memset(buff, 0 , 4);
  372. if( sendcmd(FLUSH_CACHE, i, buff, 4, 0, 0, 0))
  373. {
  374. printk(KERN_WARNING "Unable to flush cache on controller %dn",
  375.  i);
  376. }
  377. free_irq(hba[i]->intr, hba[i]);
  378. pdev->driver_data = NULL;
  379. /* remove it from the disk list */
  380. del_gendisk(&(hba[i]->gendisk));
  382. iounmap(hba[i]->vaddr);
  383. unregister_blkdev(MAJOR_NR+i, hba[i]->devname);
  384. del_timer(&hba[i]->timer);
  385. blk_cleanup_queue(BLK_DEFAULT_QUEUE(MAJOR_NR + i));
  386. remove_proc_entry(hba[i]->devname, proc_array);
  387. pci_free_consistent(hba[i]->pci_dev, 
  388. NR_CMDS * sizeof(cmdlist_t), (hba[i]->cmd_pool), 
  389. hba[i]->cmd_pool_dhandle);
  390. kfree(hba[i]->cmd_pool_bits);
  391. release_io_mem(hba[i]);
  392. free_hba(i);
  393. }
  395. /* removing an instance that was not removed automatically.. 
  396.  * must be an eisa card. 
  397.  */
  398. static void __devexit cpqarray_remove_one_eisa (int i)
  399. {
  400. char buff[4]; 
  402. if (hba[i] == NULL) 
  403. {
  404. printk(KERN_ERR "cpqarray: device appears to "
  405. "already be removed n");
  406. return;
  407. }
  409. /* sendcmd will turn off interrupt, and send the flush... 
  410.  * To write all data in the battery backed cache to disks    
  411.  * no data returned, but don't want to send NULL to sendcmd */
  412. if( sendcmd(FLUSH_CACHE, i, buff, 4, 0, 0, 0))
  413. {
  414. printk(KERN_WARNING "Unable to flush cache on controller %dn",
  415.  i);
  416. }
  417. free_irq(hba[i]->intr, hba[i]);
  418. /* remove it from the disk list */
  419. del_gendisk(&(hba[i]->gendisk));
  421. iounmap(hba[i]->vaddr);
  422. unregister_blkdev(MAJOR_NR+i, hba[i]->devname);
  423. del_timer(&hba[i]->timer);
  424. blk_cleanup_queue(BLK_DEFAULT_QUEUE(MAJOR_NR + i));
  425. remove_proc_entry(hba[i]->devname, proc_array);
  426. pci_free_consistent(hba[i]->pci_dev, 
  427. NR_CMDS * sizeof(cmdlist_t), (hba[i]->cmd_pool), 
  428. hba[i]->cmd_pool_dhandle);
  429. kfree(hba[i]->cmd_pool_bits);
  430. release_io_mem(hba[i]);
  431. free_hba(i);
  432. }
  433. static inline int cpq_new_segment(request_queue_t *q, struct request *rq,
  434.   int max_segments)
  435. {
  436. if (rq->nr_segments < SG_MAX) {
  437. rq->nr_segments++;
  438. return 1;
  439. }
  440. return 0;
  441. }
  443. static int cpq_back_merge_fn(request_queue_t *q, struct request *rq,
  444.      struct buffer_head *bh, int max_segments)
  445. {
  446. if (blk_seg_merge_ok(rq->bhtail, bh))
  447. return 1;
  448. return cpq_new_segment(q, rq, max_segments);
  449. }
  451. static int cpq_front_merge_fn(request_queue_t *q, struct request *rq,
  452.      struct buffer_head *bh, int max_segments)
  453. {
  454. if (blk_seg_merge_ok(bh, rq->bh))
  455. return 1;
  456. return cpq_new_segment(q, rq, max_segments);
  457. }
  459. static int cpq_merge_requests_fn(request_queue_t *q, struct request *rq,
  460.  struct request *nxt, int max_segments)
  461. {
  462. int total_segments = rq->nr_segments + nxt->nr_segments;
  464. if (blk_seg_merge_ok(rq->bhtail, nxt->bh))
  465. total_segments--;
  467. if (total_segments > SG_MAX)
  468. return 0;
  470. rq->nr_segments = total_segments;
  471. return 1;
  472. }
  474. static int __init cpqarray_init_one( struct pci_dev *pdev,
  475. const struct pci_device_id *ent)
  476. {
  477. request_queue_t *q;
  478.         int i,j;
  481. printk(KERN_DEBUG "cpqarray: Device 0x%x has been found at"
  482. " bus %d dev %d func %dn",
  483. pdev->device, pdev->bus->number, PCI_SLOT(pdev->devfn),
  484. PCI_FUNC(pdev->devfn));
  485. i = alloc_cpqarray_hba();
  486. if( i < 0 ) 
  487. return (-1);
  488. memset(hba[i], 0, sizeof(ctlr_info_t));
  489. /* fill in default block size */
  490. for(j=0;j<256;j++)
  491.                 hba[i]->hardsizes[j] = BLOCK_SIZE;
  493. sprintf(hba[i]->devname, "ida%d", i);
  494.         hba[i]->ctlr = i;
  495. /* Initialize the pdev driver private data */
  496. pdev->driver_data = hba[i];
  498. if (cpqarray_pci_init(hba[i], pdev) != 0)
  499. {
  500. release_io_mem(hba[i]);
  501. free_hba(i);
  502. return (-1);
  503. }
  505. /* 
  506.  * register block devices
  507.  * Find disks and fill in structs
  508.  * Get an interrupt, set the Q depth and get into /proc
  509.  */
  511. /* If this successful it should insure that we are the only */
  512. /* instance of the driver */
  513. if (register_blkdev(MAJOR_NR+i, hba[i]->devname, &ida_fops)) 
  514. {
  515.          printk(KERN_ERR "cpqarray: Unable to get major number %d for idan",
  516.                                 MAJOR_NR+i);
  517.                 release_io_mem(hba[i]);
  518.                 free_hba(i);
  519.                 return (-1);
  520.         }
  523. hba[i]->access.set_intr_mask(hba[i], 0);
  524. if (request_irq(hba[i]->intr, do_ida_intr,
  525. SA_INTERRUPT|SA_SHIRQ, hba[i]->devname, hba[i])) 
  526. {
  528. printk(KERN_ERR "cpqarray: Unable to get irq %d for %sn", 
  529. hba[i]->intr, hba[i]->devname);
  530. unregister_blkdev(MAJOR_NR+i, hba[i]->devname);
  531. release_io_mem(hba[i]);
  532.                 free_hba(i);
  533.                 return (-1);
  534. }
  535. hba[i]->cmd_pool = (cmdlist_t *)pci_alloc_consistent(
  536. hba[i]->pci_dev, NR_CMDS * sizeof(cmdlist_t), 
  537. &(hba[i]->cmd_pool_dhandle));
  538. hba[i]->cmd_pool_bits = (__u32*)kmalloc(
  539. ((NR_CMDS+31)/32)*sizeof(__u32), GFP_KERNEL);
  541. if(hba[i]->cmd_pool_bits == NULL || hba[i]->cmd_pool == NULL)
  542. {
  543. if(hba[i]->cmd_pool_bits)
  544. kfree(hba[i]->cmd_pool_bits);
  545. if(hba[i]->cmd_pool)
  546. pci_free_consistent(hba[i]->pci_dev, 
  547. NR_CMDS * sizeof(cmdlist_t), 
  548. hba[i]->cmd_pool, hba[i]->cmd_pool_dhandle);
  549. free_irq(hba[i]->intr, hba[i]);
  550. unregister_blkdev(MAJOR_NR+i, hba[i]->devname);
  551.                 printk( KERN_ERR "cpqarray: out of memory");
  552. release_io_mem(hba[i]);
  553.                 free_hba(i);
  554.                 return (-1);
  555. }
  556. memset(hba[i]->cmd_pool, 0, NR_CMDS * sizeof(cmdlist_t));
  557. memset(hba[i]->cmd_pool_bits, 0, ((NR_CMDS+31)/32)*sizeof(__u32));
  558. printk(KERN_INFO "cpqarray: Finding drives on %s", hba[i]->devname);
  559. getgeometry(i);
  560. start_fwbk(i); 
  562. hba[i]->access.set_intr_mask(hba[i], FIFO_NOT_EMPTY);
  564. ida_procinit(i);
  566. q = BLK_DEFAULT_QUEUE(MAJOR_NR + i);
  567. q->queuedata = hba[i];
  568. blk_init_queue(q, do_ida_request);
  569. blk_queue_bounce_limit(q, hba[i]->pci_dev->dma_mask);
  570. blk_queue_headactive(q, 0);
  571. blksize_size[MAJOR_NR+i] = hba[i]->blocksizes;
  572. hardsect_size[MAJOR_NR+i] = hba[i]->hardsizes;
  573. read_ahead[MAJOR_NR+i] = READ_AHEAD;
  575. q->back_merge_fn = cpq_back_merge_fn;
  576. q->front_merge_fn = cpq_front_merge_fn;
  577. q->merge_requests_fn = cpq_merge_requests_fn;
  579. hba[i]->gendisk.major = MAJOR_NR + i;
  580. hba[i]->gendisk.major_name = "ida";
  581. hba[i]->gendisk.minor_shift = NWD_SHIFT;
  582. hba[i]->gendisk.max_p = IDA_MAX_PART;
  583. hba[i]->gendisk.part = hba[i]->hd;
  584. hba[i]->gendisk.sizes = hba[i]->sizes;
  585. hba[i]->gendisk.nr_real = hba[i]->highest_lun+1; 
  587. /* Get on the disk list */
  588. add_gendisk(&(hba[i]->gendisk));
  590. init_timer(&hba[i]->timer);
  591. hba[i]->timer.expires = jiffies + IDA_TIMER;
  592. hba[i]->timer.data = (unsigned long)hba[i];
  593. hba[i]->timer.function = ida_timer;
  594. add_timer(&hba[i]->timer);
  596. ida_geninit(i);
  597. for(j=0; j<NWD; j++)
  598. register_disk(&(hba[i]->gendisk), MKDEV(MAJOR_NR+i,j<<4),
  599. IDA_MAX_PART, &ida_fops, hba[i]->drv[j].nr_blks);
  601. return(i);
  602. }
  603. static struct pci_driver cpqarray_pci_driver = {
  604.         name:   "cpqarray",
  605.         probe:  cpqarray_init_one,
  606.         remove:  __devexit_p(cpqarray_remove_one),
  607.         id_table:  cpqarray_pci_device_id,
  608. };
  610. /*
  611.  *  This is it.  Find all the controllers and register them.  I really hate
  612.  *  stealing all these major device numbers.
  613.  *  returns the number of block devices registered.
  614.  */
  615. int __init cpqarray_init(void)
  616. {
  617. int num_cntlrs_reg = 0;
  618. int i;
  620. /* detect controllers */
  621. printk(DRIVER_NAME "n");
  622. pci_register_driver(&cpqarray_pci_driver);
  623. cpqarray_eisa_detect();
  625. for(i=0; i< MAX_CTLR; i++)
  626.         {
  627. if (hba[i] != NULL)
  628. num_cntlrs_reg++;
  629. }
  630. return(num_cntlrs_reg);
  631. }
  632. /* Function to find the first free pointer into our hba[] array */
  633. /* Returns -1 if no free entries are left.  */
  634. static int alloc_cpqarray_hba(void)
  635. {
  636. int i;
  637. for(i=0; i< MAX_CTLR; i++)
  638. {
  639. if (hba[i] == NULL)
  640. {
  641. hba[i] = kmalloc(sizeof(ctlr_info_t), GFP_KERNEL);
  642. if(hba[i]==NULL)
  643. {
  644. printk(KERN_ERR "cpqarray: out of memory.n");
  645. return (-1);
  646. }
  647. return (i);
  648. }
  649. }
  650. printk(KERN_WARNING "cpqarray: This driver supports a maximum"
  651. " of 8 controllers.n");
  652. return(-1);
  653. }
  655. static void free_hba(int i)
  656. {
  657. kfree(hba[i]);
  658. hba[i]=NULL;
  659. }
  661. /*
  662.  * Find the IO address of the controller, its IRQ and so forth.  Fill
  663.  * in some basic stuff into the ctlr_info_t structure.
  664.  */
  665. static int cpqarray_pci_init(ctlr_info_t *c, struct pci_dev *pdev)
  666. {
  667. ushort vendor_id, device_id, command;
  668. unchar cache_line_size, latency_timer;
  669. unchar irq, revision;
  670. unsigned long addr[6];
  671. __u32 board_id;
  673. int i;
  675. pci_read_config_word(pdev, PCI_COMMAND, &command);
  676. /* check to see if controller has been disabled */
  677. if(!(command & 0x02))
  678. {
  679. printk(KERN_WARNING "cpqarray: controller appears to be disabledn");
  680. return(-1);
  681. }
  683. c->pci_dev = pdev;
  684. vendor_id = pdev->vendor;
  685. device_id = pdev->device;
  686. irq = pdev->irq;
  688. for(i=0; i<6; i++)
  689. addr[i] = pci_resource_start(pdev, i);
  691. if (pci_enable_device(pdev))
  692. {
  693. printk(KERN_ERR "cpqarray: Unable to Enable PCI devicen");
  694. return -1;
  695. }
  696. if (pci_set_dma_mask(pdev, CPQARRAY_DMA_MASK) != 0)
  697. {
  698. printk(KERN_ERR "cpqarray: Unable to set DMA maskn");
  699. return -1;
  700. }
  702. pci_read_config_byte(pdev, PCI_CLASS_REVISION, &revision);
  703. pci_read_config_byte(pdev, PCI_CACHE_LINE_SIZE, &cache_line_size);
  704. pci_read_config_byte(pdev, PCI_LATENCY_TIMER, &latency_timer);
  706. pci_read_config_dword(pdev, 0x2c, &board_id);
  708. DBGINFO(
  709. printk("vendor_id = %xn", vendor_id);
  710. printk("device_id = %xn", device_id);
  711. printk("command = %xn", command);
  712. for(i=0; i<6; i++)
  713. printk("addr[%d] = %lxn", i, addr[i]);
  714. printk("revision = %xn", revision);
  715. printk("irq = %xn", irq);
  716. printk("cache_line_size = %xn", cache_line_size);
  717. printk("latency_timer = %xn", latency_timer);
  718. printk("board_id = %xn", board_id);
  719. );
  721. c->intr = irq;
  722. for(i=0; i<6; i++)
  723. {
  724. if (pci_resource_flags(pdev, i) & PCI_BASE_ADDRESS_SPACE_IO)
  725. { /* IO space */  
  726. c->io_mem_addr = addr[i];
  727. c->io_mem_length = pci_resource_end(pdev, i) 
  728. - pci_resource_start(pdev, i) +1; 
  729. // printk("IO Value found addr[%d] %lx %lxn",
  730. // i, c->io_mem_addr, c->io_mem_length);
  731. if(!request_region( c->io_mem_addr, c->io_mem_length,
  732. "cpqarray"))
  733. {
  734. printk( KERN_WARNING "cpqarray I/O memory range already in use addr %lx length = %ldn", c->io_mem_addr, c->io_mem_length);
  735. c->io_mem_addr = 0;
  736. c->io_mem_length = 0;
  737. }
  738. break;
  739. }
  740. }
  741. c->paddr = 0;
  742. for(i=0; i<6; i++)
  743. if (!(pci_resource_flags(pdev, i) & PCI_BASE_ADDRESS_SPACE_IO)) {
  744. c->paddr = pci_resource_start (pdev, i);
  745. break;
  746. }
  747. if (!c->paddr)
  748. return -1;
  749. c->vaddr = remap_pci_mem(c->paddr, 128);
  750. if (!c->vaddr)
  751. return -1;
  752. c->board_id = board_id;
  754. for(i=0; i<NR_PRODUCTS; i++) {
  755. if (board_id == products[i].board_id) {
  756. c->product_name = products[i].product_name;
  757. c->access = *(products[i].access);
  758. break;
  759. }
  760. }
  761. if (i == NR_PRODUCTS) {
  762. printk(KERN_WARNING "cpqarray: Sorry, I don't know how"
  763. " to access the SMART Array controller %08lxn", 
  764. (unsigned long)board_id);
  765. return -1;
  766. }
  768. return 0;
  769. }
  771. /*
  772.  * Map (physical) PCI mem into (virtual) kernel space
  773.  */
  774. static void *remap_pci_mem(ulong base, ulong size)
  775. {
  776.         ulong page_base        = ((ulong) base) & PAGE_MASK;
  777.         ulong page_offs        = ((ulong) base) - page_base;
  778.         void *page_remapped    = ioremap(page_base, page_offs+size);
  780.         return (page_remapped ? (page_remapped + page_offs) : NULL);
  781. }
  783. #ifndef MODULE
  784. #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,3,13)
  785. /*
  786.  * Config string is a comma seperated set of i/o addresses of EISA cards.
  787.  */
  788. static int cpqarray_setup(char *str)
  789. {
  790. int i, ints[9];
  792. (void)get_options(str, ARRAY_SIZE(ints), ints);
  794. for(i=0; i<ints[0] && i<8; i++)
  795. eisa[i] = ints[i+1];
  796. return 1;
  797. }
  799. __setup("smart2=", cpqarray_setup);
  801. #else
  803. /*
  804.  * Copy the contents of the ints[] array passed to us by init.
  805.  */
  806. void cpqarray_setup(char *str, int *ints)
  807. {
  808. int i;
  809. for(i=0; i<ints[0] && i<8; i++)
  810. eisa[i] = ints[i+1];
  811. }
  812. #endif
  813. #endif
  815. /*
  816.  * Find an EISA controller's signature.  Set up an hba if we find it.
  817.  */
  818. static int cpqarray_eisa_detect(void)
  819. {
  820. int i=0, j;
  821. __u32 board_id;
  822. int intr;
  823. int ctlr;
  824. int num_ctlr = 0;
  825. while(i<8 && eisa[i]) {
  826. ctlr = alloc_cpqarray_hba();
  827. if (ctlr == -1 ) {
  828. break;
  829. }
  830. board_id = inl(eisa[i]+0xC80);
  831. for(j=0; j < NR_PRODUCTS; j++)
  832. if (board_id == products[j].board_id) 
  833. break;
  835. if (j == NR_PRODUCTS) {
  836. printk(KERN_WARNING "cpqarray: Sorry, I don't know how"
  837. " to access the SMART Array controller %08lxn",  (unsigned long)board_id);
  838. free_hba(ctlr);
  839. continue;
  840. }
  841. memset(hba[ctlr], 0, sizeof(ctlr_info_t));
  842. hba[ctlr]->io_mem_addr = eisa[i];
  843. hba[ctlr]->io_mem_length = 0x7FF;
  844. if(!request_region( hba[ctlr]->io_mem_addr, 
  845. hba[ctlr]->io_mem_length, 
  846. "cpqarray"))
  847. {
  848. printk( KERN_WARNING "cpqarray: I/0 range already in use addr = %lx length=%ldn",
  849.  hba[ctlr]->io_mem_addr, hba[ctlr]->io_mem_length);
  850. free_hba(ctlr);
  851. continue;
  852. }
  853. /*
  854.  * Read the config register to find our interrupt
  855.  */
  856. intr = inb(eisa[i]+0xCC0) >> 4;
  857. if (intr & 1) intr = 11;
  858. else if (intr & 2) intr = 10;
  859. else if (intr & 4) intr = 14;
  860. else if (intr & 8) intr = 15;
  862. hba[ctlr]->intr = intr;
  863. sprintf(hba[ctlr]->devname, "ida%d", ctlr);
  864. hba[ctlr]->product_name = products[j].product_name;
  865. hba[ctlr]->access = *(products[j].access);
  866. hba[ctlr]->ctlr = ctlr;
  867. hba[ctlr]->board_id = board_id;
  868. hba[ctlr]->pci_dev = NULL; /* not PCI */
  870. DBGINFO(
  871. printk("i = %d, j = %dn", i, j);
  872. printk("irq = %xn", intr);
  873. printk("product name = %sn", products[j].product_name);
  874. printk("board_id = %xn", board_id);
  875. );
  877. num_ctlr++;
  878. i++;
  879. }
  881. return num_ctlr;
  882. }
  885. /*
  886.  * Open.  Make sure the device is really there.
  887.  */
  888. static int ida_open(struct inode *inode, struct file *filep)
  889. {
  890. int ctlr = MAJOR(inode->i_rdev) - MAJOR_NR;
  891. int dsk  = MINOR(inode->i_rdev) >> NWD_SHIFT;
  893. DBGINFO(printk("ida_open %x (%x:%x)n", inode->i_rdev, ctlr, dsk) );
  894. if (ctlr > MAX_CTLR || hba[ctlr] == NULL)
  895. return -ENXIO;
  897. if (!suser() && hba[ctlr]->sizes[ MINOR(inode->i_rdev)] == 0)
  898. return -ENXIO;
  900. /*
  901.  * Root is allowed to open raw volume zero even if its not configured
  902.  * so array config can still work.  I don't think I really like this,
  903.  * but I'm already using way to many device nodes to claim another one
  904.  * for "raw controller".
  905.  */
  906. if (suser()
  907. && hba[ctlr]->sizes[ MINOR(inode->i_rdev)] == 0 
  908. && MINOR(inode->i_rdev) != 0)
  909. return -ENXIO;
  911. hba[ctlr]->drv[dsk].usage_count++;
  912. hba[ctlr]->usage_count++;
  913. return 0;
  914. }
  916. /*
  917.  * Close.  Sync first.
  918.  */
  919. static int ida_release(struct inode *inode, struct file *filep)
  920. {
  921. int ctlr = MAJOR(inode->i_rdev) - MAJOR_NR;
  922. int dsk  = MINOR(inode->i_rdev) >> NWD_SHIFT;
  924. DBGINFO(printk("ida_release %x (%x:%x)n", inode->i_rdev, ctlr, dsk) );
  926. hba[ctlr]->drv[dsk].usage_count--;
  927. hba[ctlr]->usage_count--;
  928. return 0;
  929. }
  931. /*
  932.  * Enqueuing and dequeuing functions for cmdlists.
  933.  */
  934. static inline void addQ(cmdlist_t **Qptr, cmdlist_t *c)
  935. {
  936. if (*Qptr == NULL) {
  937. *Qptr = c;
  938. c->next = c->prev = c;
  939. } else {
  940. c->prev = (*Qptr)->prev;
  941. c->next = (*Qptr);
  942. (*Qptr)->prev->next = c;
  943. (*Qptr)->prev = c;
  944. }
  945. }
  947. static inline cmdlist_t *removeQ(cmdlist_t **Qptr, cmdlist_t *c)
  948. {
  949. if (c && c->next != c) {
  950. if (*Qptr == c) *Qptr = c->next;
  951. c->prev->next = c->next;
  952. c->next->prev = c->prev;
  953. } else {
  954. *Qptr = NULL;
  955. }
  956. return c;
  957. }
  959. /*
  960.  * Get a request and submit it to the controller.
  961.  * This routine needs to grab all the requests it possibly can from the
  962.  * req Q and submit them.  Interrupts are off (and need to be off) when you
  963.  * are in here (either via the dummy do_ida_request functions or by being
  964.  * called from the interrupt handler
  965.  */
  966. static void do_ida_request(request_queue_t *q)
  967. {
  968. ctlr_info_t *h = q->queuedata;
  969. cmdlist_t *c;
  970. unsigned long lastdataend;
  971. struct list_head * queue_head = &q->queue_head;
  972. struct buffer_head *bh;
  973. struct request *creq;
  974. struct scatterlist tmp_sg[SG_MAX];
  975. int i, seg;
  977. if (q->plugged)
  978. goto startio;
  980. next:
  981. if (list_empty(queue_head))
  982. goto startio;
  984. creq = blkdev_entry_next_request(queue_head);
  985. if (creq->nr_segments > SG_MAX)
  986. BUG();
  988. if (h->ctlr != MAJOR(creq->rq_dev)-MAJOR_NR )
  989. {
  990. printk(KERN_WARNING "doreq cmd for %d, %x at %pn",
  991. h->ctlr, creq->rq_dev, creq);
  992. blkdev_dequeue_request(creq);
  993. complete_buffers(creq->bh, 0);
  994. end_that_request_last(creq);
  995. goto startio;
  996. }
  998. if ((c = cmd_alloc(h,1)) == NULL)
  999. goto startio;
  1001. blkdev_dequeue_request(creq);
  1003. spin_unlock_irq(&io_request_lock);
  1005. bh = creq->bh;
  1007. c->ctlr = h->ctlr;
  1008. c->hdr.unit = MINOR(creq->rq_dev) >> NWD_SHIFT;
  1009. c->hdr.size = sizeof(rblk_t) >> 2;
  1010. c->size += sizeof(rblk_t);
  1012. c->req.hdr.blk = hba[h->ctlr]->hd[MINOR(creq->rq_dev)].start_sect 
  1013. + creq->sector;
  1014. c->rq = creq;
  1015. DBGPX(
  1016. if (bh == NULL)
  1017. panic("bh == NULL?");
  1019. printk("sector=%d, nr_sectors=%dn", creq->sector, creq->nr_sectors);
  1020. );
  1021. seg = 0;
  1022. lastdataend = ~0UL;
  1023. while(bh) {
  1024. if (bh_phys(bh) == lastdataend) {
  1025. tmp_sg[seg-1].length += bh->b_size;
  1026. lastdataend += bh->b_size;
  1027. } else {
  1028. if (seg == SG_MAX)
  1029. BUG();
  1030. tmp_sg[seg].page = bh->b_page;
  1031. tmp_sg[seg].length = bh->b_size;
  1032. tmp_sg[seg].offset = bh_offset(bh);
  1033. lastdataend = bh_phys(bh) + bh->b_size;
  1034. seg++;
  1035. }
  1036. bh = bh->b_reqnext;
  1037. }
  1038. /* Now do all the DMA Mappings */
  1039. for( i=0; i < seg; i++)
  1040. {
  1041. c->req.sg[i].size = tmp_sg[i].length;
  1042. c->req.sg[i].addr = (__u32) pci_map_page(
  1043.                  h->pci_dev, tmp_sg[i].page, tmp_sg[i].offset,
  1044. tmp_sg[i].length,
  1045.                                 (creq->cmd == READ) ? 
  1046. PCI_DMA_FROMDEVICE : PCI_DMA_TODEVICE);
  1047. }
  1048. DBGPX( printk("Submitting %d sectors in %d segmentsn", sect, seg); );
  1049. c->req.hdr.sg_cnt = seg;
  1050. c->req.hdr.blk_cnt = creq->nr_sectors;
  1051. c->req.hdr.cmd = (creq->cmd == READ) ? IDA_READ : IDA_WRITE;
  1052. c->type = CMD_RWREQ;
  1054. spin_lock_irq(&io_request_lock);
  1056. /* Put the request on the tail of the request queue */
  1057. addQ(&h->reqQ, c);
  1058. h->Qdepth++;
  1059. if (h->Qdepth > h->maxQsinceinit) 
  1060. h->maxQsinceinit = h->Qdepth;
  1062. goto next;
  1064. startio:
  1065. start_io(h);
  1066. }
  1068. /* 
  1069.  * start_io submits everything on a controller's request queue
  1070.  * and moves it to the completion queue.
  1071.  *
  1072.  * Interrupts had better be off if you're in here
  1073.  */
  1074. static void start_io(ctlr_info_t *h)
  1075. {
  1076. cmdlist_t *c;
  1078. while((c = h->reqQ) != NULL) {
  1079. /* Can't do anything if we're busy */
  1080. if (h->access.fifo_full(h) == 0)
  1081. return;
  1083. /* Get the first entry from the request Q */
  1084. removeQ(&h->reqQ, c);
  1085. h->Qdepth--;
  1087. /* Tell the controller to do our bidding */
  1088. h->access.submit_command(h, c);
  1090. /* Get onto the completion Q */
  1091. addQ(&h->cmpQ, c);
  1092. }
  1093. }
  1095. static inline void complete_buffers(struct buffer_head *bh, int ok)
  1096. {
  1097. struct buffer_head *xbh;
  1098. while(bh) {
  1099. xbh = bh->b_reqnext;
  1100. bh->b_reqnext = NULL;
  1102. blk_finished_io(bh->b_size >> 9);
  1103. bh->b_end_io(bh, ok);
  1105. bh = xbh;
  1106. }
  1107. }
  1108. /*
  1109.  * Mark all buffers that cmd was responsible for
  1110.  */
  1111. static inline void complete_command(cmdlist_t *cmd, int timeout)
  1112. {
  1113. int ok=1;
  1114. int i;
  1116. if (cmd->req.hdr.rcode & RCODE_NONFATAL &&
  1117.    (hba[cmd->ctlr]->misc_tflags & MISC_NONFATAL_WARN) == 0) {
  1118. printk(KERN_NOTICE "Non Fatal error on ida/c%dd%dn",
  1119. cmd->ctlr, cmd->hdr.unit);
  1120. hba[cmd->ctlr]->misc_tflags |= MISC_NONFATAL_WARN;
  1121. }
  1122. if (cmd->req.hdr.rcode & RCODE_FATAL) {
  1123. printk(KERN_WARNING "Fatal error on ida/c%dd%dn",
  1124. cmd->ctlr, cmd->hdr.unit);
  1125. ok = 0;
  1126. }
  1127. if (cmd->req.hdr.rcode & RCODE_INVREQ) {
  1128. printk(KERN_WARNING "Invalid request on ida/c%dd%d = (cmd=%x sect=%d cnt=%d sg=%d ret=%x)n",
  1129. cmd->ctlr, cmd->hdr.unit, cmd->req.hdr.cmd,
  1130. cmd->req.hdr.blk, cmd->req.hdr.blk_cnt,
  1131. cmd->req.hdr.sg_cnt, cmd->req.hdr.rcode);
  1132. ok = 0;
  1133. }
  1134. if (timeout) ok = 0;
  1135. /* unmap the DMA mapping for all the scatter gather elements */
  1136.         for(i=0; i<cmd->req.hdr.sg_cnt; i++)
  1137.         {
  1138.                 pci_unmap_page(hba[cmd->ctlr]->pci_dev,
  1139.                         cmd->req.sg[i].addr, cmd->req.sg[i].size,
  1140.                         (cmd->req.hdr.cmd == IDA_READ) ? PCI_DMA_FROMDEVICE : PCI_DMA_TODEVICE);
  1141.         }
  1143. complete_buffers(cmd->rq->bh, ok);
  1144. DBGPX(printk("Done with %pn", cmd->rq););
  1145. end_that_request_last(cmd->rq);
  1146. }
  1148. /*
  1149.  *  The controller will interrupt us upon completion of commands.
  1150.  *  Find the command on the completion queue, remove it, tell the OS and
  1151.  *  try to queue up more IO
  1152.  */
  1153. static void do_ida_intr(int irq, void *dev_id, struct pt_regs *regs)
  1154. {
  1155. ctlr_info_t *h = dev_id;
  1156. cmdlist_t *c;
  1157. unsigned long istat;
  1158. unsigned long flags;
  1159. __u32 a,a1;
  1161. istat = h->access.intr_pending(h);
  1162. /* Is this interrupt for us? */
  1163. if (istat == 0)
  1164. return;
  1166. /*
  1167.  * If there are completed commands in the completion queue,
  1168.  * we had better do something about it.
  1169.  */
  1170. spin_lock_irqsave(&io_request_lock, flags);
  1171. if (istat & FIFO_NOT_EMPTY) {
  1172. while((a = h->access.command_completed(h))) {
  1173. a1 = a; a &= ~3;
  1174. if ((c = h->cmpQ) == NULL)
  1175. {  
  1176. printk(KERN_WARNING "cpqarray: Completion of %08lx ignoredn", (unsigned long)a1);
  1177. continue;
  1178. } 
  1179. while(c->busaddr != a) {
  1180. c = c->next;
  1181. if (c == h->cmpQ) 
  1182. break;
  1183. }
  1184. /*
  1185.  * If we've found the command, take it off the
  1186.  * completion Q and free it
  1187.  */
  1188. if (c->busaddr == a) {
  1189. removeQ(&h->cmpQ, c);
  1190. /*  Check for invalid command.
  1191.                                  *  Controller returns command error,
  1192.                                  *  But rcode = 0.
  1193.                                  */
  1195. if((a1 & 0x03) && (c->req.hdr.rcode == 0))
  1196.                                 {
  1197.                                  c->req.hdr.rcode = RCODE_INVREQ;
  1198.                                 }
  1199. if (c->type == CMD_RWREQ) {
  1200. complete_command(c, 0);
  1201. cmd_free(h, c, 1);
  1202. } else if (c->type == CMD_IOCTL_PEND) {
  1203. c->type = CMD_IOCTL_DONE;
  1204. }
  1205. continue;
  1206. }
  1207. }
  1208. }
  1210. /*
  1211.  * See if we can queue up some more IO
  1212.  */
  1213. do_ida_request(BLK_DEFAULT_QUEUE(MAJOR_NR + h->ctlr));
  1214. spin_unlock_irqrestore(&io_request_lock, flags);
  1215. }
  1217. /*
  1218.  * This timer was for timing out requests that haven't happened after
  1219.  * IDA_TIMEOUT.  That wasn't such a good idea.  This timer is used to
  1220.  * reset a flags structure so we don't flood the user with
  1221.  * "Non-Fatal error" messages.
  1222.  */
  1223. static void ida_timer(unsigned long tdata)
  1224. {
  1225. ctlr_info_t *h = (ctlr_info_t*)tdata;
  1227. h->timer.expires = jiffies + IDA_TIMER;
  1228. add_timer(&h->timer);
  1229. h->misc_tflags = 0;
  1230. }
  1232. /*
  1233.  *  ida_ioctl does some miscellaneous stuff like reporting drive geometry,
  1234.  *  setting readahead and submitting commands from userspace to the controller.
  1235.  */
  1236. static int ida_ioctl(struct inode *inode, struct file *filep, unsigned int cmd, unsigned long arg)
  1237. {
  1238. int ctlr = MAJOR(inode->i_rdev) - MAJOR_NR;
  1239. int dsk  = MINOR(inode->i_rdev) >> NWD_SHIFT;
  1240. int error;
  1241. ida_ioctl_t *io = (ida_ioctl_t*)arg;
  1242. ida_ioctl_t my_io;
  1244. switch(cmd) {
  1245. case HDIO_GETGEO:
  1246. {
  1247. struct hd_geometry driver_geo;
  1249. if (hba[ctlr]->drv[dsk].cylinders) {
  1250. driver_geo.heads = hba[ctlr]->drv[dsk].heads;
  1251. driver_geo.sectors = hba[ctlr]->drv[dsk].sectors;
  1252. driver_geo.cylinders = hba[ctlr]->drv[dsk].cylinders;
  1253. } else {
  1254. driver_geo.heads = 0xff;
  1255. driver_geo.sectors = 0x3f;
  1256. driver_geo.cylinders = hba[ctlr]->drv[dsk].nr_blks 
  1257. / (0xff*0x3f);
  1258. }
  1259. driver_geo.start=
  1260. hba[ctlr]->hd[MINOR(inode->i_rdev)].start_sect;
  1261. if (copy_to_user((void *) arg, &driver_geo,
  1262. sizeof( struct hd_geometry)))
  1263. return  -EFAULT;
  1264. return(0);
  1265. }
  1266. case HDIO_GETGEO_BIG:
  1267. {
  1268. struct hd_big_geometry driver_geo;
  1270. if (hba[ctlr]->drv[dsk].cylinders) {
  1271. driver_geo.heads = hba[ctlr]->drv[dsk].heads;
  1272. driver_geo.sectors = hba[ctlr]->drv[dsk].sectors;
  1273. driver_geo.cylinders = hba[ctlr]->drv[dsk].cylinders;
  1274. } else {
  1275. driver_geo.heads = 0xff;
  1276. driver_geo.sectors = 0x3f;
  1277. driver_geo.cylinders = hba[ctlr]->drv[dsk].nr_blks 
  1278. / (0xff*0x3f);
  1279. }
  1280. driver_geo.start=
  1281. hba[ctlr]->hd[MINOR(inode->i_rdev)].start_sect;
  1282. if (copy_to_user((void *) arg, &driver_geo,
  1283. sizeof( struct hd_big_geometry)))
  1284. return  -EFAULT;
  1285. return(0);
  1286. }
  1288. case IDAGETDRVINFO:
  1289. return copy_to_user(&io->c.drv,&hba[ctlr]->drv[dsk],sizeof(drv_info_t));
  1290. case BLKGETSIZE:
  1291. if (!arg) return -EINVAL;
  1292. return put_user(hba[ctlr]->hd[MINOR(inode->i_rdev)].nr_sects, 
  1293. (unsigned long *)arg);
  1294. case BLKGETSIZE64:
  1295. return put_user((u64)(hba[ctlr]->hd[MINOR(inode->i_rdev)].nr_sects) << 9, (u64*)arg);
  1296. case BLKRRPART:
  1297. return revalidate_logvol(inode->i_rdev, 1);
  1298. case IDAPASSTHRU:
  1299. if (!suser()) return -EPERM;
  1300. error = copy_from_user(&my_io, io, sizeof(my_io));
  1301. if (error) return error;
  1302. error = ida_ctlr_ioctl(ctlr, dsk, &my_io);
  1303. if (error) return error;
  1304. if(copy_to_user(io, &my_io, sizeof(my_io)))
  1305. return -EFAULT;
  1306. return error;
  1307. case IDAGETCTLRSIG:
  1308. if (!arg) return -EINVAL;
  1309. put_user(hba[ctlr]->ctlr_sig, (int*)arg);
  1310. return 0;
  1311. case IDAREVALIDATEVOLS:
  1312. return revalidate_allvol(inode->i_rdev);
  1313. case IDADRIVERVERSION:
  1314. if (!arg) return -EINVAL;
  1315. put_user(DRIVER_VERSION, (unsigned long*)arg);
  1316. return 0;
  1317. case IDAGETPCIINFO:
  1318. {
  1320. ida_pci_info_struct pciinfo;
  1322. if (!arg) return -EINVAL;
  1323. pciinfo.bus = hba[ctlr]->pci_dev->bus->number;
  1324. pciinfo.dev_fn = hba[ctlr]->pci_dev->devfn;
  1325. pciinfo.board_id = hba[ctlr]->board_id;
  1326. if(copy_to_user((void *) arg, &pciinfo,  
  1327. sizeof( ida_pci_info_struct)))
  1328. return -EFAULT;
  1329. return(0);
  1330. }
  1331. case IDADEREGDISK:
  1332. return( deregister_disk(ctlr,dsk));
  1333. case IDAREGNEWDISK:
  1334. {
  1335. int logvol = arg; 
  1336. return(register_new_disk(ctlr, logvol));
  1337. }
  1339. case IDAGETLOGINFO:
  1340. {
  1341. idaLogvolInfo_struct luninfo;
  1342. int num_parts = 0;
  1343. int i, start;
  1345. luninfo.LogVolID = dsk; 
  1346. luninfo.num_opens = hba[ctlr]->drv[dsk].usage_count;
  1348. /* count partitions 1 to 15 with sizes > 0 */
  1349. start = (dsk << NWD_SHIFT); 
  1350. for(i=1; i <IDA_MAX_PART; i++)
  1351. {
  1352. int minor = start+i;
  1353. if(hba[ctlr]->sizes[minor] != 0)
  1354. num_parts++;
  1355. }
  1356. luninfo.num_parts = num_parts;
  1357. if (copy_to_user((void *) arg, &luninfo, 
  1358. sizeof( idaLogvolInfo_struct) ))
  1359. return -EFAULT;
  1360. return(0);
  1361. }
  1363. case BLKFLSBUF:
  1364. case BLKBSZSET:
  1365. case BLKBSZGET:
  1366. case BLKROSET:
  1367. case BLKROGET:
  1368. case BLKRASET:
  1369. case BLKRAGET:
  1370. case BLKELVGET:
  1371. case BLKELVSET:
  1372. case BLKPG:
  1373. return blk_ioctl(inode->i_rdev, cmd, arg);
  1375. default:
  1376. return -EINVAL;
  1377. }
  1379. }
  1380. /*
  1381.  * ida_ctlr_ioctl is for passing commands to the controller from userspace.
  1382.  * The command block (io) has already been copied to kernel space for us,
  1383.  * however, any elements in the sglist need to be copied to kernel space
  1384.  * or copied back to userspace.
  1385.  *
  1386.  * Only root may perform a controller passthru command, however I'm not doing
  1387.  * any serious sanity checking on the arguments.  Doing an IDA_WRITE_MEDIA and
  1388.  * putting a 64M buffer in the sglist is probably a *bad* idea.
  1389.  */
  1390. static int ida_ctlr_ioctl(int ctlr, int dsk, ida_ioctl_t *io)
  1391. {
  1392. ctlr_info_t *h = hba[ctlr];
  1393. cmdlist_t *c;
  1394. void *p = NULL;
  1395. unsigned long flags;
  1396. int error;
  1398. if ((c = cmd_alloc(h, 0)) == NULL)
  1399. return -ENOMEM;
  1400. c->ctlr = ctlr;
  1401. c->hdr.unit = (io->unit & UNITVALID) ? (io->unit & ~UNITVALID) : dsk;
  1402. c->hdr.size = sizeof(rblk_t) >> 2;
  1403. c->size += sizeof(rblk_t);
  1405. c->req.hdr.cmd = io->cmd;
  1406. c->req.hdr.blk = io->blk;
  1407. c->req.hdr.blk_cnt = io->blk_cnt;
  1408. c->type = CMD_IOCTL_PEND;
  1410. /* Pre submit processing */
  1411. switch(io->cmd) {
  1412. case PASSTHRU_A:
  1413. p = kmalloc(io->sg[0].size, GFP_KERNEL);
  1414. if (!p) 
  1415. { 
  1416. error = -ENOMEM; 
  1417. cmd_free(h, c, 0); 
  1418. return(error);
  1419. }
  1420. if (copy_from_user(p, (void*)io->sg[0].addr, io->sg[0].size)) {
  1421. kfree(p);
  1422. cmd_free(h, c, 0); 
  1423. return -EFAULT;
  1424. }
  1425. c->req.hdr.blk = pci_map_single(h->pci_dev, &(io->c), 
  1426. sizeof(ida_ioctl_t), 
  1427. PCI_DMA_BIDIRECTIONAL);
  1428. c->req.sg[0].size = io->sg[0].size;
  1429. c->req.sg[0].addr = pci_map_single(h->pci_dev, p, 
  1430. c->req.sg[0].size, PCI_DMA_BIDIRECTIONAL);
  1431. c->req.hdr.sg_cnt = 1;
  1432. break;
  1433. case IDA_READ:
  1434. case READ_FLASH_ROM:
  1435. case SENSE_CONTROLLER_PERFORMANCE:
  1436. p = kmalloc(io->sg[0].size, GFP_KERNEL);
  1437. if (!p) 
  1438. { 
  1439.                         error = -ENOMEM; 
  1440.                         cmd_free(h, c, 0);
  1441.                         return(error);
  1442.                 }
  1444. c->req.sg[0].size = io->sg[0].size;
  1445. c->req.sg[0].addr = pci_map_single(h->pci_dev, p, 
  1446. c->req.sg[0].size, PCI_DMA_BIDIRECTIONAL); 
  1447. c->req.hdr.sg_cnt = 1;
  1448. break;
  1449. case IDA_WRITE:
  1450. case IDA_WRITE_MEDIA:
  1451. case DIAG_PASS_THRU:
  1452. case COLLECT_BUFFER:
  1453. case WRITE_FLASH_ROM:
  1454. p = kmalloc(io->sg[0].size, GFP_KERNEL);
  1455. if (!p) 
  1456.   { 
  1457.                         error = -ENOMEM; 
  1458.                         cmd_free(h, c, 0);
  1459.                         return(error);
  1460.                 }
  1461. if (copy_from_user(p, (void*)io->sg[0].addr, io->sg[0].size)) {
  1462. kfree(p);
  1463.                         cmd_free(h, c, 0);
  1464. return -EFAULT;
  1465. }
  1466. c->req.sg[0].size = io->sg[0].size;
  1467. c->req.sg[0].addr = pci_map_single(h->pci_dev, p, 
  1468. c->req.sg[0].size, PCI_DMA_BIDIRECTIONAL); 
  1469. c->req.hdr.sg_cnt = 1;
  1470. break;
  1471. default:
  1472. c->req.sg[0].size = sizeof(io->c);
  1473. c->req.sg[0].addr = pci_map_single(h->pci_dev,&io->c, 
  1474. c->req.sg[0].size, PCI_DMA_BIDIRECTIONAL);
  1475. c->req.hdr.sg_cnt = 1;
  1476. }
  1478. /* Put the request on the tail of the request queue */
  1479. spin_lock_irqsave(&io_request_lock, flags);
  1480. addQ(&h->reqQ, c);
  1481. h->Qdepth++;
  1482. start_io(h);
  1483. spin_unlock_irqrestore(&io_request_lock, flags);
  1485. /* Wait for completion */
  1486. while(c->type != CMD_IOCTL_DONE)
  1487. schedule();
  1489. /* Unmap the DMA  */
  1490. pci_unmap_single(h->pci_dev, c->req.sg[0].addr, c->req.sg[0].size, 
  1491. PCI_DMA_BIDIRECTIONAL);
  1492. /* Post submit processing */
  1493. switch(io->cmd) {
  1494. case PASSTHRU_A:
  1495. pci_unmap_single(h->pci_dev, c->req.hdr.blk,
  1496.                                 sizeof(ida_ioctl_t),
  1497.                                 PCI_DMA_BIDIRECTIONAL);
  1498. case IDA_READ:
  1499. case DIAG_PASS_THRU:
  1500. case SENSE_CONTROLLER_PERFORMANCE:
  1501. case READ_FLASH_ROM:
  1502. if (copy_to_user((void*)io->sg[0].addr, p, io->sg[0].size)) {
  1503. kfree(p);
  1504. return -EFAULT;
  1505. }
  1506. /* fall through and free p */
  1507. case IDA_WRITE:
  1508. case IDA_WRITE_MEDIA:
  1509. case COLLECT_BUFFER:
  1510. case WRITE_FLASH_ROM:
  1511. kfree(p);
  1512. break;
  1513. default:;
  1514. /* Nothing to do */
  1515. }
  1517. io->rcode = c->req.hdr.rcode;
  1518. cmd_free(h, c, 0);
  1519. return(0);
  1520. }
  1522. /*
  1523.  * Commands are pre-allocated in a large block.  Here we use a simple bitmap
  1524.  * scheme to suballocte them to the driver.  Operations that are not time
  1525.  * critical (and can wait for kmalloc and possibly sleep) can pass in NULL
  1526.  * as the first argument to get a new command.
  1527.  */
  1528. static cmdlist_t * cmd_alloc(ctlr_info_t *h, int get_from_pool)
  1529. {
  1530. cmdlist_t * c;
  1531. int i;
  1532. dma_addr_t cmd_dhandle;
  1534. if (!get_from_pool) {
  1535. c = (cmdlist_t*)pci_alloc_consistent(h->pci_dev, 
  1536. sizeof(cmdlist_t), &cmd_dhandle);
  1537. if(c==NULL)
  1538. return NULL;
  1539. } else {
  1540. do {
  1541. i = find_first_zero_bit(h->cmd_pool_bits, NR_CMDS);
  1542. if (i == NR_CMDS)
  1543. return NULL;
  1544. } while(test_and_set_bit(i%32, h->cmd_pool_bits+(i/32)) != 0);
  1545. c = h->cmd_pool + i;
  1546. cmd_dhandle = h->cmd_pool_dhandle + i*sizeof(cmdlist_t);
  1547. h->nr_allocs++;
  1548. }
  1550. memset(c, 0, sizeof(cmdlist_t));
  1551. c->busaddr = cmd_dhandle; 
  1552. return c;
  1553. }
  1555. static void cmd_free(ctlr_info_t *h, cmdlist_t *c, int got_from_pool)
  1556. {
  1557. int i;
  1559. if (!got_from_pool) {
  1560. pci_free_consistent(h->pci_dev, sizeof(cmdlist_t), c,
  1561. c->busaddr);
  1562. } else {
  1563. i = c - h->cmd_pool;
  1564. clear_bit(i%32, h->cmd_pool_bits+(i/32));
  1565. h->nr_frees++;
  1566. }
  1567. }
  1569. /***********************************************************************
  1570.     name:        sendcmd
  1571.     Send a command to an IDA using the memory mapped FIFO interface
  1572.     and wait for it to complete.  
  1573.     This routine should only be called at init time.
  1574. ***********************************************************************/
  1575. static int sendcmd(
  1576. __u8 cmd,
  1577. int ctlr,
  1578. void *buff,
  1579. size_t size,
  1580. unsigned int blk,
  1581. unsigned int blkcnt,
  1582. unsigned int log_unit )
  1583. {
  1584. cmdlist_t *c;
  1585. int complete;
  1586. unsigned long temp;
  1587. unsigned long i;
  1588. ctlr_info_t *info_p = hba[ctlr];
  1590. c = cmd_alloc(info_p, 1);
  1591. if(!c)
  1592. return IO_ERROR;
  1593. c->ctlr = ctlr;
  1594. c->hdr.unit = log_unit;
  1595. c->hdr.prio = 0;
  1596. c->hdr.size = sizeof(rblk_t) >> 2;
  1597. c->size += sizeof(rblk_t);
  1599. /* The request information. */
  1600. c->req.hdr.next = 0;
  1601. c->req.hdr.rcode = 0;
  1602. c->req.bp = 0;
  1603. c->req.hdr.sg_cnt = 1;
  1604. c->req.hdr.reserved = 0;
  1606. if (size == 0)
  1607. c->req.sg[0].size = 512;
  1608. else
  1609. c->req.sg[0].size = size;
  1611. c->req.hdr.blk = blk;
  1612. c->req.hdr.blk_cnt = blkcnt;
  1613. c->req.hdr.cmd = (unsigned char) cmd;
  1614. c->req.sg[0].addr = (__u32) pci_map_single(info_p->pci_dev, 
  1615. buff, c->req.sg[0].size, PCI_DMA_BIDIRECTIONAL);
  1616. /*
  1617.  * Disable interrupt
  1618.  */
  1619. info_p->access.set_intr_mask(info_p, 0);
  1620. /* Make sure there is room in the command FIFO */
  1621. /* Actually it should be completely empty at this time. */
  1622. for (i = 200000; i > 0; i--) {
  1623. temp = info_p->access.fifo_full(info_p);
  1624. if (temp != 0) {
  1625. break;
  1626. }
  1627. udelay(10);
  1628. DBG(
  1629. printk(KERN_WARNING "cpqarray ida%d: idaSendPciCmd FIFO full,"
  1630. " waiting!n", ctlr);
  1631. );
  1632. } 
  1633. /*
  1634.  * Send the cmd
  1635.  */
  1636. info_p->access.submit_command(info_p, c);
  1637. complete = pollcomplete(ctlr);
  1639. pci_unmap_single(info_p->pci_dev, (dma_addr_t) c->req.sg[0].addr, 
  1640. c->req.sg[0].size, PCI_DMA_BIDIRECTIONAL);
  1641. if (complete != 1) {
  1642. if (complete != c->busaddr) {
  1643. printk( KERN_WARNING
  1644. "cpqarray ida%d: idaSendPciCmd "
  1645.       "Invalid command list address returned! (%08lx)n",
  1646. ctlr, (unsigned long)complete);
  1647. cmd_free(info_p, c, 1);
  1648. return (IO_ERROR);
  1649. }
  1650. } else {
  1651. printk( KERN_WARNING
  1652. "cpqarray ida%d: idaSendPciCmd Timeout out, "
  1653. "No command list address returned!n",
  1654. ctlr);
  1655. cmd_free(info_p, c, 1);
  1656. return (IO_ERROR);
  1657. }
  1659. if (c->req.hdr.rcode & 0x00FE) {
  1660. if (!(c->req.hdr.rcode & BIG_PROBLEM)) {
  1661. printk( KERN_WARNING
  1662. "cpqarray ida%d: idaSendPciCmd, error: "
  1663. "Controller failed at init time "
  1664. "cmd: 0x%x, return code = 0x%xn",
  1665. ctlr, c->req.hdr.cmd, c->req.hdr.rcode);
  1667. cmd_free(info_p, c, 1);
  1668. return (IO_ERROR);
  1669. }
  1670. }
  1671. cmd_free(info_p, c, 1);
  1672. return (IO_OK);
  1673. }
  1675. static int frevalidate_logvol(kdev_t dev)
  1676. {
  1677. return revalidate_logvol(dev, 0);
  1678. }
  1680. /*
  1681.  * revalidate_allvol is for online array config utilities.  After a
  1682.  * utility reconfigures the drives in the array, it can use this function
  1683.  * (through an ioctl) to make the driver zap any previous disk structs for
  1684.  * that controller and get new ones.
  1685.  *
  1686.  * Right now I'm using the getgeometry() function to do this, but this
  1687.  * function should probably be finer grained and allow you to revalidate one
  1688.  * particualar logical volume (instead of all of them on a particular
  1689.  * controller).
  1690.  */
  1691. static int revalidate_allvol(kdev_t dev)
  1692. {
  1693. int ctlr, i;
  1694. unsigned long flags;
  1696. ctlr = MAJOR(dev) - MAJOR_NR;
  1697. if (MINOR(dev) != 0)
  1698. return -ENXIO;
  1700. spin_lock_irqsave(&io_request_lock, flags);
  1701. if (hba[ctlr]->usage_count > 1) {
  1702. spin_unlock_irqrestore(&io_request_lock, flags);
  1703. printk(KERN_WARNING "cpqarray: Device busy for volume"
  1704. " revalidation (usage=%d)n", hba[ctlr]->usage_count);
  1705. return -EBUSY;
  1706. }
  1707. spin_unlock_irqrestore(&io_request_lock, flags);
  1708. hba[ctlr]->usage_count++;
  1710. /*
  1711.  * Set the partition and block size structures for all volumes
  1712.  * on this controller to zero.  And set the hardsizes to non zero to 
  1713.  * avoid a possible divide by zero error.  
  1714.  * We will reread all of this data
  1715.  */
  1716. memset(hba[ctlr]->hd,         0, sizeof(struct hd_struct)*NWD*16);
  1717. memset(hba[ctlr]->sizes,      0, sizeof(int)*NWD*16);
  1718. memset(hba[ctlr]->blocksizes, 0, sizeof(int)*NWD*16);
  1719. memset(hba[ctlr]->drv,        0, sizeof(drv_info_t)*NWD);
  1720. hba[ctlr]->gendisk.nr_real = 0;
  1722. for(i=0;i<256;i++)
  1723.                 hba[ctlr]->hardsizes[i] = BLOCK_SIZE;
  1724. /*
  1725.  * Tell the array controller not to give us any interrupts while
  1726.  * we check the new geometry.  Then turn interrupts back on when
  1727.  * we're done.
  1728.  */
  1729. hba[ctlr]->access.set_intr_mask(hba[ctlr], 0);
  1730. getgeometry(ctlr);
  1731. hba[ctlr]->access.set_intr_mask(hba[ctlr], FIFO_NOT_EMPTY);
  1733. ida_geninit(ctlr);
  1734. for(i=0; i<NWD; i++)
  1735. if (hba[ctlr]->sizes[i<<NWD_SHIFT])
  1736. revalidate_logvol(dev+(i<<NWD_SHIFT), 2);
  1738. hba[ctlr]->usage_count--;
  1739. return 0;
  1740. }
  1742. static int deregister_disk(int ctlr, int logvol)
  1743. {
  1744. unsigned long flags;
  1745. struct gendisk *gdev = &(hba[ctlr]->gendisk); 
  1746. ctlr_info_t  *h = hba[ctlr];
  1747. int start, max_p, i;
  1750. if (!capable(CAP_SYS_RAWIO))
  1751. return -EPERM;
  1753. spin_lock_irqsave(&io_request_lock, flags);
  1754. /* make sure logical volume is NOT is use */
  1755. if( h->drv[logvol].usage_count > 1)
  1756. {
  1757. spin_unlock_irqrestore(&io_request_lock, flags);
  1758.                 return -EBUSY;
  1759. }
  1760. h->drv[logvol].usage_count++;
  1761. spin_unlock_irqrestore(&io_request_lock, flags);
  1763. /* invalidate the devices and deregister the disk */ 
  1764. max_p = gdev->max_p;
  1765. start = logvol << gdev->minor_shift;
  1766. for (i=max_p-1; i>=0; i--)
  1767. {
  1768. int minor = start+i;
  1769. // printk("invalidating( %d %d)n", ctlr, minor);
  1770. invalidate_device(MKDEV(MAJOR_NR+ctlr, minor), 1);
  1771. /* so open will now fail */
  1772. hba[ctlr]->sizes[minor] = 0;
  1773. }
  1774. /* check to see if it was the last disk */
  1775. if (logvol == h->highest_lun)
  1776. {
  1777. /* if so, find the new hightest lun */
  1778. int i, newhighest =-1;
  1779. for(i=0; i<h->highest_lun; i++)
  1780. {
  1781. /* if the disk has size > 0, it is available */
  1782. if (hba[ctlr]->sizes[i << gdev->minor_shift] != 0)
  1783. newhighest = i;
  1784. }
  1785. h->highest_lun = newhighest;
  1787. }
  1788. --h->log_drives;
  1789. gdev->nr_real = h->highest_lun+1; 
  1790. /* zero out the disk size info */ 
  1791. h->drv[logvol].nr_blks = 0;
  1792. h->drv[logvol].blk_size = BLOCK_SIZE;
  1793. return(0);
  1795. }
  1797. static int sendcmd_withirq(
  1798. __u8 cmd,
  1799. int ctlr,
  1800. void *buff,
  1801. size_t size,
  1802. unsigned int blk,
  1803. unsigned int blkcnt,
  1804. unsigned int log_unit )
  1805. {
  1806. cmdlist_t *c;
  1807. unsigned long flags;
  1808. ctlr_info_t *info_p = hba[ctlr];
  1810. c = cmd_alloc(info_p, 0);
  1811. if(!c)
  1812. return IO_ERROR;
  1813. c->type = CMD_IOCTL_PEND;
  1814. c->ctlr = ctlr;
  1815. c->hdr.unit = log_unit;
  1816. c->hdr.prio = 0;
  1817. c->hdr.size = sizeof(rblk_t) >> 2;
  1818. c->size += sizeof(rblk_t);
  1820. /* The request information. */
  1821. c->req.hdr.next = 0;
  1822. c->req.hdr.rcode = 0;
  1823. c->req.bp = 0;
  1824. c->req.hdr.sg_cnt = 1;
  1825. c->req.hdr.reserved = 0;
  1827. if (size == 0)
  1828. c->req.sg[0].size = 512;
  1829. else
  1830. c->req.sg[0].size = size;
  1832. c->req.hdr.blk = blk;
  1833. c->req.hdr.blk_cnt = blkcnt;
  1834. c->req.hdr.cmd = (unsigned char) cmd;
  1835. c->req.sg[0].addr = (__u32) pci_map_single(info_p->pci_dev, 
  1836. buff, c->req.sg[0].size, PCI_DMA_BIDIRECTIONAL);
  1838. /* Put the request on the tail of the request queue */
  1839. spin_lock_irqsave(&io_request_lock, flags);
  1840. addQ(&info_p->reqQ, c);
  1841. info_p->Qdepth++;
  1842. start_io(info_p);
  1843. spin_unlock_irqrestore(&io_request_lock, flags);
  1845. /* Wait for completion */
  1846. while(c->type != CMD_IOCTL_DONE)
  1847. schedule();
  1849. if (c->req.hdr.rcode & RCODE_FATAL) {
  1850. printk(KERN_WARNING "Fatal error on ida/c%dd%dn",
  1851. c->ctlr, c->hdr.unit);
  1852. cmd_free(info_p, c, 0);
  1853. return(IO_ERROR);
  1854. }
  1855. if (c->req.hdr.rcode & RCODE_INVREQ) {
  1856. printk(KERN_WARNING "Invalid request on ida/c%dd%d = (cmd=%x sect=%d cnt=%d sg=%d ret=%x)n",
  1857. c->ctlr, c->hdr.unit, c->req.hdr.cmd,
  1858. c->req.hdr.blk, c->req.hdr.blk_cnt,
  1859. c->req.hdr.sg_cnt, c->req.hdr.rcode);
  1860. cmd_free(info_p, c, 0);
  1861. return(IO_ERROR);
  1862. }
  1863. cmd_free(info_p, c, 0);
  1864. return(IO_OK);
  1865. }
  1867. static int register_new_disk(int ctlr, int logvol)
  1868. {
  1869. struct gendisk *gdev = &(hba[ctlr]->gendisk);
  1870. ctlr_info_t *info_p = hba[ctlr];
  1871. int ret_code, size;
  1872. sense_log_drv_stat_t *id_lstatus_buf;
  1873. id_log_drv_t *id_ldrive;
  1874. drv_info_t *drv;
  1875. int max_p;
  1876. int start;
  1877. int i;
  1879. if (!capable(CAP_SYS_RAWIO))
  1880. return -EPERM;
  1881. if( (logvol < 0) || (logvol >= IDA_MAX_PART))
  1882. return -EINVAL;
  1883. /* disk is already registered */
  1884. if(hba[ctlr]->sizes[logvol <<  gdev->minor_shift] != 0 )
  1885. return -EINVAL;
  1887. id_ldrive = (id_log_drv_t *)kmalloc(sizeof(id_log_drv_t), GFP_KERNEL);
  1888. if(id_ldrive == NULL)
  1889. {
  1890. printk( KERN_ERR "cpqarray:  out of memory.n");
  1891. return -1;
  1892. }
  1893. id_lstatus_buf = (sense_log_drv_stat_t *)kmalloc(sizeof(sense_log_drv_stat_t), GFP_KERNEL);
  1894. if(id_lstatus_buf == NULL)
  1895. {
  1896. kfree(id_ldrive);
  1897. printk( KERN_ERR "cpqarray:  out of memory.n");
  1898. return -1;
  1899. }
  1901. size = sizeof(sense_log_drv_stat_t);
  1903. /*
  1904. Send "Identify logical drive status" cmd
  1905.  */
  1906. ret_code = sendcmd_withirq(SENSE_LOG_DRV_STAT,
  1907. ctlr, id_lstatus_buf, size, 0, 0, logvol);
  1908. if (ret_code == IO_ERROR) 
  1909. {
  1910. /*
  1911.    If can't get logical drive status, set
  1912.    the logical drive map to 0, so the
  1913.    idastubopen will fail for all logical drives
  1914.    on the controller. 
  1915.  */
  1916. /* Free all the buffers and return */
  1918.                 kfree(id_lstatus_buf);
  1919.                 kfree(id_ldrive);
  1920.                 return -1;
  1921. }
  1922. /*
  1923.    Make sure the logical drive is configured
  1924.  */
  1925. if (id_lstatus_buf->status == LOG_NOT_CONF) 
  1926. {
  1927. printk(KERN_WARNING "cpqarray: c%dd%d array not configuredn",
  1928. ctlr, logvol); 
  1929. kfree(id_lstatus_buf);
  1930.                 kfree(id_ldrive);
  1931. return -1;
  1932. }
  1933. ret_code = sendcmd_withirq(ID_LOG_DRV, ctlr, id_ldrive,
  1934.        sizeof(id_log_drv_t), 0, 0, logvol);
  1935. /*
  1936.    If error, the bit for this
  1937.    logical drive won't be set and
  1938.    idastubopen will return error. 
  1939.  */
  1940. if (ret_code == IO_ERROR) 
  1941. {
  1942. printk(KERN_WARNING "cpqarray: c%dd%d unable to ID logical volumen",
  1943. ctlr,logvol);
  1944. kfree(id_lstatus_buf);
  1945.                 kfree(id_ldrive);
  1946. return -1;
  1947. }
  1948. drv = &info_p->drv[logvol];
  1949. drv->blk_size = id_ldrive->blk_size;
  1950. drv->nr_blks = id_ldrive->nr_blks;
  1951. drv->cylinders = id_ldrive->drv.cyl;
  1952. drv->heads = id_ldrive->drv.heads;
  1953. drv->sectors = id_ldrive->drv.sect_per_track;
  1954. info_p->log_drv_map |= (1 << logvol);
  1955. if (info_p->highest_lun < logvol)
  1956. info_p->highest_lun = logvol;
  1958. printk(KERN_INFO "cpqarray ida/c%dd%d: blksz=%d nr_blks=%dn",
  1959. ctlr, logvol, drv->blk_size, drv->nr_blks);
  1961. hba[ctlr]->drv[logvol].usage_count = 0;
  1963. max_p = gdev->max_p;
  1964. start = logvol<< gdev->minor_shift;
  1966. for(i=max_p-1; i>=0; i--) 
  1967. {
  1968. int minor = start+i;
  1969. invalidate_device(MKDEV(MAJOR_NR + ctlr, minor), 1);
  1970. gdev->part[minor].start_sect = 0;
  1971. gdev->part[minor].nr_sects = 0;
  1973. /* reset the blocksize so we can read the partition table */
  1974. blksize_size[MAJOR_NR+ctlr][minor] = 1024;
  1975. }
  1976. ++hba[ctlr]->log_drives;
  1977. gdev->nr_real = info_p->highest_lun + 1;
  1978. /* setup partitions per disk */
  1979. grok_partitions(gdev, logvol, IDA_MAX_PART, drv->nr_blks); 
  1981. kfree(id_lstatus_buf);
  1982.         kfree(id_ldrive);
  1983. return (0);
  1984. }
  1986. /* Borrowed and adapted from sd.c */
  1987. static int revalidate_logvol(kdev_t dev, int maxusage)
  1988. {
  1989. int ctlr, target;
  1990. struct gendisk *gdev;
  1991. unsigned long flags;
  1992. int max_p;
  1993. int start;
  1994. int i;
  1996. target = DEVICE_NR(dev);
  1997. ctlr = MAJOR(dev) - MAJOR_NR;
  1998. gdev = &(hba[ctlr]->gendisk);
  2000. spin_lock_irqsave(&io_request_lock, flags);
  2001. if (hba[ctlr]->drv[target].usage_count > maxusage) {
  2002. spin_unlock_irqrestore(&io_request_lock, flags);
  2003. printk(KERN_WARNING "cpqarray: Device busy for "
  2004. "revalidation (usage=%d)n",
  2005. hba[ctlr]->drv[target].usage_count);
  2006. return -EBUSY;
  2007. }
  2009. hba[ctlr]->drv[target].usage_count++;
  2010. spin_unlock_irqrestore(&io_request_lock, flags);
  2012. max_p = gdev->max_p;
  2013. start = target << gdev->minor_shift;
  2015. for(i=max_p-1; i>=0; i--) {
  2016. int minor = start+i;
  2017. invalidate_device(MKDEV(MAJOR_NR + ctlr, minor), 1);
  2018. gdev->part[minor].start_sect = 0;
  2019. gdev->part[minor].nr_sects = 0;
  2021. /* reset the blocksize so we can read the partition table */
  2022. blksize_size[MAJOR_NR+ctlr][minor] = 1024;
  2023. }
  2025. /* 16 minors per disk... */
  2026. grok_partitions(gdev, target, IDA_MAX_PART, 
  2027. hba[ctlr]->drv[target].nr_blks);
  2028. hba[ctlr]->drv[target].usage_count--;
  2029. return 0;
  2030. }
  2033. /********************************************************************
  2034.     name: pollcomplete
  2035.     Wait polling for a command to complete.
  2036.     The memory mapped FIFO is polled for the completion.
  2037.     Used only at init time, interrupts disabled.
  2038.  ********************************************************************/
  2039. static int pollcomplete(int ctlr)
  2040. {
  2041. int done;
  2042. int i;
  2044. /* Wait (up to 2 seconds) for a command to complete */
  2046. for (i = 200000; i > 0; i--) {
  2047. done = hba[ctlr]->access.command_completed(hba[ctlr]);
  2048. if (done == 0) {
  2049. udelay(10); /* a short fixed delay */
  2050. } else
  2051. return (done);
  2052. }
  2053. /* Invalid address to tell caller we ran out of time */
  2054. return 1;
  2055. }
  2056. /*****************************************************************
  2057.     start_fwbk
  2058.     Starts controller firmwares background processing. 
  2059.     Currently only the Integrated Raid controller needs this done.
  2060.     If the PCI mem address registers are written to after this, 
  2061.  data corruption may occur
  2062. *****************************************************************/
  2063. static void start_fwbk(int ctlr)
  2064. {
  2065. id_ctlr_t *id_ctlr_buf; 
  2066. int ret_code;
  2068. if( (hba[ctlr]->board_id != 0x40400E11)
  2069. && (hba[ctlr]->board_id != 0x40480E11) )
  2071. /* Not a Integrated Raid, so there is nothing for us to do */
  2072. return;
  2073. printk(KERN_DEBUG "cpqarray: Starting firmware's background"
  2074. " processingn");
  2075. /* Command does not return anything, but idasend command needs a 
  2076. buffer */
  2077. id_ctlr_buf = (id_ctlr_t *)kmalloc(sizeof(id_ctlr_t), GFP_KERNEL);
  2078. if(id_ctlr_buf==NULL)
  2079. {
  2080. printk(KERN_WARNING "cpqarray: Out of memory. "
  2081. "Unable to start background processing.n");
  2082. return;
  2083. }
  2084. ret_code = sendcmd(RESUME_BACKGROUND_ACTIVITY, ctlr, 
  2085. id_ctlr_buf, 0, 0, 0, 0);
  2086. if(ret_code != IO_OK)
  2087. printk(KERN_WARNING "cpqarray: Unable to start"
  2088. " background processingn");
  2090. kfree(id_ctlr_buf);
  2091. }
  2092. /*****************************************************************
  2093.     getgeometry
  2094.     Get ida logical volume geometry from the controller 
  2095.     This is a large bit of code which once existed in two flavors,
  2096.     It is used only at init time.
  2097. *****************************************************************/
  2098. static void getgeometry(int ctlr)
  2099. {
  2100. id_log_drv_t *id_ldrive;
  2101. id_ctlr_t *id_ctlr_buf;
  2102. sense_log_drv_stat_t *id_lstatus_buf;
  2103. config_t *sense_config_buf;
  2104. unsigned int log_unit, log_index;
  2105. int ret_code, size;
  2106. drv_info_t *drv;
  2107. ctlr_info_t *info_p = hba[ctlr];
  2108. int i;
  2110. info_p->log_drv_map = 0;
  2112. id_ldrive = (id_log_drv_t *)kmalloc(sizeof(id_log_drv_t), GFP_KERNEL);
  2113. if(id_ldrive == NULL)
  2114. {
  2115. printk( KERN_ERR "cpqarray:  out of memory.n");
  2116. return;
  2117. }
  2119. id_ctlr_buf = (id_ctlr_t *)kmalloc(sizeof(id_ctlr_t), GFP_KERNEL);
  2120. if(id_ctlr_buf == NULL)
  2121. {
  2122. kfree(id_ldrive);
  2123. printk( KERN_ERR "cpqarray:  out of memory.n");
  2124. return;
  2125. }
  2127. id_lstatus_buf = (sense_log_drv_stat_t *)kmalloc(sizeof(sense_log_drv_stat_t), GFP_KERNEL);
  2128. if(id_lstatus_buf == NULL)
  2129. {
  2130. kfree(id_ctlr_buf);
  2131. kfree(id_ldrive);
  2132. printk( KERN_ERR "cpqarray:  out of memory.n");
  2133. return;
  2134. }
  2136. sense_config_buf = (config_t *)kmalloc(sizeof(config_t), GFP_KERNEL);
  2137. if(sense_config_buf == NULL)
  2138. {
  2139. kfree(id_lstatus_buf);
  2140. kfree(id_ctlr_buf);
  2141. kfree(id_ldrive);
  2142. printk( KERN_ERR "cpqarray:  out of memory.n");
  2143. return;
  2144. }
  2146. memset(id_ldrive, 0, sizeof(id_log_drv_t));
  2147. memset(id_ctlr_buf, 0, sizeof(id_ctlr_t));
  2148. memset(id_lstatus_buf, 0, sizeof(sense_log_drv_stat_t));
  2149. memset(sense_config_buf, 0, sizeof(config_t));
  2151. info_p->phys_drives = 0;
  2152. info_p->log_drv_map = 0;
  2153. info_p->drv_assign_map = 0;
  2154. info_p->drv_spare_map = 0;
  2155. info_p->mp_failed_drv_map = 0; /* only initialized here */
  2156. /* Get controllers info for this logical drive */
  2157. ret_code = sendcmd(ID_CTLR, ctlr, id_ctlr_buf, 0, 0, 0, 0);
  2158. if (ret_code == IO_ERROR) {
  2159. /*
  2160.  * If can't get controller info, set the logical drive map to 0,
  2161.  * so the idastubopen will fail on all logical drives
  2162.  * on the controller.
  2163.  */
  2164.  /* Free all the buffers and return */ 
  2165. printk(KERN_ERR "cpqarray: error sending ID controllern");
  2166. kfree(sense_config_buf);
  2167.                 kfree(id_lstatus_buf);
  2168.                 kfree(id_ctlr_buf);
  2169.                 kfree(id_ldrive);
  2170.                 return;
  2171.         }
  2173. info_p->log_drives = id_ctlr_buf->nr_drvs;;
  2174. for(i=0;i<4;i++)
  2175. info_p->firm_rev[i] = id_ctlr_buf->firm_rev[i];
  2176. info_p->ctlr_sig = id_ctlr_buf->cfg_sig;
  2178. printk(" (%s)n", info_p->product_name);
  2179. /*
  2180.  * Initialize logical drive map to zero
  2181.  */
  2182. log_index = 0;
  2183. /*
  2184.  * Get drive geometry for all logical drives
  2185.  */
  2186. if (id_ctlr_buf->nr_drvs > IDA_MAX_PART)
  2187. printk(KERN_WARNING "cpqarray ida%d:  This driver supports "
  2188. "16 logical drives per controller.n.  "
  2189. " Additional drives will not be "
  2190. "detectedn", ctlr);
  2192. for (log_unit = 0;
  2193.      (log_index < id_ctlr_buf->nr_drvs)
  2194.      && (log_unit < NWD);
  2195.      log_unit++) {
  2197. size = sizeof(sense_log_drv_stat_t);
  2199. /*
  2200.    Send "Identify logical drive status" cmd
  2201.  */
  2202. ret_code = sendcmd(SENSE_LOG_DRV_STAT,
  2203.      ctlr, id_lstatus_buf, size, 0, 0, log_unit);
  2204. if (ret_code == IO_ERROR) {
  2205. /*
  2206.    If can't get logical drive status, set
  2207.    the logical drive map to 0, so the
  2208.    idastubopen will fail for all logical drives
  2209.    on the controller. 
  2210.  */
  2211. info_p->log_drv_map = 0;
  2212. printk( KERN_WARNING
  2213.      "cpqarray ida%d: idaGetGeometry - Controller"
  2214. " failed to report status of logical drive %dn"
  2215.  "Access to this controller has been disabledn",
  2216. ctlr, log_unit);
  2217. /* Free all the buffers and return */
  2218.                  kfree(sense_config_buf);
  2219.                  kfree(id_lstatus_buf);
  2220.                  kfree(id_ctlr_buf);
  2221.                  kfree(id_ldrive);
  2222.                  return;
  2223. }
  2224. /*
  2225.    Make sure the logical drive is configured
  2226.  */
  2227. if (id_lstatus_buf->status != LOG_NOT_CONF) {
  2228. ret_code = sendcmd(ID_LOG_DRV, ctlr, id_ldrive,
  2229.        sizeof(id_log_drv_t), 0, 0, log_unit);
  2230. /*
  2231.    If error, the bit for this
  2232.    logical drive won't be set and
  2233.    idastubopen will return error. 
  2234.  */
  2235. if (ret_code != IO_ERROR) {
  2236. drv = &info_p->drv[log_unit];
  2237. drv->blk_size = id_ldrive->blk_size;
  2238. drv->nr_blks = id_ldrive->nr_blks;
  2239. drv->cylinders = id_ldrive->drv.cyl;
  2240. drv->heads = id_ldrive->drv.heads;
  2241. drv->sectors = id_ldrive->drv.sect_per_track;
  2242. info_p->log_drv_map |= (1 << log_unit);
  2244. printk(KERN_INFO "cpqarray ida/c%dd%d: blksz=%d nr_blks=%dn",
  2245. ctlr, log_unit, drv->blk_size, drv->nr_blks);
  2246. ret_code = sendcmd(SENSE_CONFIG,
  2247.   ctlr, sense_config_buf,
  2248.  sizeof(config_t), 0, 0, log_unit);
  2249. if (ret_code == IO_ERROR) {
  2250. info_p->log_drv_map = 0;
  2251. /* Free all the buffers and return */
  2252.                  printk(KERN_ERR "cpqarray: error sending sense confign");
  2253.                  kfree(sense_config_buf);
  2254.                  kfree(id_lstatus_buf);
  2255.                  kfree(id_ctlr_buf);
  2256.                  kfree(id_ldrive);
  2257.                  return;
  2259. }
  2260. if(log_unit > info_p->highest_lun)
  2261. info_p->highest_lun = log_unit;
  2262. info_p->phys_drives =
  2263.     sense_config_buf->ctlr_phys_drv;
  2264. info_p->drv_assign_map
  2265.     |= sense_config_buf->drv_asgn_map;
  2266. info_p->drv_assign_map
  2267.     |= sense_config_buf->spare_asgn_map;
  2268. info_p->drv_spare_map
  2269.     |= sense_config_buf->spare_asgn_map;
  2270. } /* end of if no error on id_ldrive */
  2271. log_index = log_index + 1;
  2272. } /* end of if logical drive configured */
  2273. } /* end of for log_unit */
  2274. kfree(sense_config_buf);
  2275.    kfree(id_ldrive);
  2276.    kfree(id_lstatus_buf);
  2277. kfree(id_ctlr_buf);
  2278. return;
  2280. }
  2282. static void __exit cleanup_cpqarray_module(void)
  2283. {
  2284.         int i;
  2286.         pci_unregister_driver(&cpqarray_pci_driver);
  2287.         /* double check that all controller entrys have been removed */
  2288.         for (i=0; i< MAX_CTLR; i++)
  2289.         {
  2290.                 if (hba[i] != NULL)
  2291.                 {
  2292.                         printk(KERN_WARNING "cpqarray: had to remove"
  2293.                                         " controller %dn", i);
  2294.                         cpqarray_remove_one_eisa(i);
  2295.                 }
  2296.         }
  2297.         remove_proc_entry("cpqarray", proc_root_driver);
  2298. }
  2301. module_init(init_cpqarray_module);
  2302. module_exit(cleanup_cpqarray_module);