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

源码开发语言/平台
当前位置：首页 > 源码/资料 > 嵌入式/单片机编程 > 嵌入式Linux > 查看源码
cpqarray.c
资源名称：SBC-2410X_kernel.tar.gz　[点击查看]
上传用户：lgb322
上传日期：2013-02-24
资源大小：30529k
文件大小：51k
源码类别：

嵌入式Linux

开发平台：

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/devfs_fs_kernel.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>
  43. #define SMART2_DRIVER_VERSION(maj,min,submin) ((maj<<16)|(min<<8)|(submin))
  45. #define DRIVER_NAME "Compaq SMART2 Driver (v 2.4.5)"
  46. #define DRIVER_VERSION SMART2_DRIVER_VERSION(2,4,5)
  48. /* Embedded module documentation macros - see modules.h */
  49. /* Original author Chris Frantz - Compaq Computer Corporation */
  50. MODULE_AUTHOR("Compaq Computer Corporation");
  51. MODULE_DESCRIPTION("Driver for Compaq Smart2 Array Controllers");
  52. MODULE_LICENSE("GPL");
  54. #define MAJOR_NR COMPAQ_SMART2_MAJOR
  55. #include <linux/blk.h>
  56. #include <linux/blkdev.h>
  57. #include <linux/genhd.h>
  59. #include "cpqarray.h"
  60. #include "ida_cmd.h"
  61. #include "smart1,2.h"
  62. #include "ida_ioctl.h"
  64. #define READ_AHEAD 128
  65. #define NR_CMDS 128 /* This could probably go as high as ~400 */
  67. #define MAX_CTLR 8
  68. #define CTLR_SHIFT 8
  70. #define CPQARRAY_DMA_MASK 0xFFFFFFFF /* 32 bit DMA */
  72. static int nr_ctlr;
  73. static ctlr_info_t *hba[MAX_CTLR];
  74. static devfs_handle_t de_arr[MAX_CTLR][NWD];
  76. static int eisa[8];
  78. #define NR_PRODUCTS (sizeof(products)/sizeof(struct board_type))
  80. /*  board_id = Subsystem Device ID & Vendor ID
  81.  *  product = Marketing Name for the board
  82.  *  access = Address of the struct of function pointers 
  83.  */
  84. static struct board_type products[] = {
  85. { 0x0040110E, "IDA", &smart1_access },
  86. { 0x0140110E, "IDA-2", &smart1_access },
  87. { 0x1040110E, "IAES", &smart1_access },
  88. { 0x2040110E, "SMART", &smart1_access },
  89. { 0x3040110E, "SMART-2/E", &smart2e_access },
  90. { 0x40300E11, "SMART-2/P", &smart2_access },
  91. { 0x40310E11, "SMART-2SL", &smart2_access },
  92. { 0x40320E11, "Smart Array 3200", &smart2_access },
  93. { 0x40330E11, "Smart Array 3100ES", &smart2_access },
  94. { 0x40340E11, "Smart Array 221", &smart2_access },
  95. { 0x40400E11, "Integrated Array", &smart4_access },
  96. { 0x40480E11, "Compaq Raid LC2",        &smart4_access },
  97. { 0x40500E11, "Smart Array 4200", &smart4_access },
  98. { 0x40510E11, "Smart Array 4250ES", &smart4_access },
  99. { 0x40580E11, "Smart Array 431", &smart4_access },
  100. };
  102. static struct hd_struct * ida;
  103. static int * ida_sizes;
  104. static int * ida_blocksizes;
  105. static int * ida_hardsizes;
  106. static struct gendisk ida_gendisk[MAX_CTLR];
  108. static struct proc_dir_entry *proc_array;
  110. /* Debug... */
  111. #define DBG(s) do { s } while(0)
  112. /* Debug (general info)... */
  113. #define DBGINFO(s) do { } while(0)
  114. /* Debug Paranoid... */
  115. #define DBGP(s)  do { } while(0)
  116. /* Debug Extra Paranoid... */
  117. #define DBGPX(s) do { } while(0)
  119. int cpqarray_init(void);
  120. static int cpqarray_pci_detect(void);
  121. static int cpqarray_pci_init(ctlr_info_t *c, struct pci_dev *pdev);
  122. static void *remap_pci_mem(ulong base, ulong size);
  123. static int cpqarray_eisa_detect(void);
  124. static int pollcomplete(int ctlr);
  125. static void getgeometry(int ctlr);
  126. static void start_fwbk(int ctlr);
  128. static cmdlist_t * cmd_alloc(ctlr_info_t *h, int get_from_pool);
  129. static void cmd_free(ctlr_info_t *h, cmdlist_t *c, int got_from_pool);
  131. static int sendcmd(
  132. __u8 cmd,
  133. int ctlr,
  134. void *buff,
  135. size_t size,
  136. unsigned int blk,
  137. unsigned int blkcnt,
  138. unsigned int log_unit );
  140. static int ida_open(struct inode *inode, struct file *filep);
  141. static int ida_release(struct inode *inode, struct file *filep);
  142. static int ida_ioctl(struct inode *inode, struct file *filep, unsigned int cmd, unsigned long arg);
  143. static int ida_ctlr_ioctl(int ctlr, int dsk, ida_ioctl_t *io);
  145. static void do_ida_request(request_queue_t *q);
  146. static void start_io(ctlr_info_t *h);
  148. static inline void addQ(cmdlist_t **Qptr, cmdlist_t *c);
  149. static inline cmdlist_t *removeQ(cmdlist_t **Qptr, cmdlist_t *c);
  150. static inline void complete_buffers(struct buffer_head *bh, int ok);
  151. static inline void complete_command(cmdlist_t *cmd, int timeout);
  153. static void do_ida_intr(int irq, void *dev_id, struct pt_regs * regs);
  154. static void ida_timer(unsigned long tdata);
  155. static int frevalidate_logvol(kdev_t dev);
  156. static int revalidate_logvol(kdev_t dev, int maxusage);
  157. static int revalidate_allvol(kdev_t dev);
  159. #ifdef CONFIG_PROC_FS
  160. static void ida_procinit(int i);
  161. static int ida_proc_get_info(char *buffer, char **start, off_t offset, int length, int *eof, void *data);
  162. #else
  163. static void ida_procinit(int i) {}
  164. static int ida_proc_get_info(char *buffer, char **start, off_t offset,
  165.      int length, int *eof, void *data) { return 0;}
  166. #endif
  168. static void ida_geninit(int ctlr)
  169. {
  170. int i,j;
  171. drv_info_t *drv;
  173. for(i=0; i<NWD; i++) {
  174. drv = &hba[ctlr]->drv[i];
  175. if (!drv->nr_blks)
  176. continue;
  177. ida[(ctlr<<CTLR_SHIFT) + (i<<NWD_SHIFT)].nr_sects =
  178. ida_sizes[(ctlr<<CTLR_SHIFT) + (i<<NWD_SHIFT)] =
  179. drv->nr_blks;
  181. for(j=0; j<16; j++) {
  182. ida_blocksizes[(ctlr<<CTLR_SHIFT) + (i<<NWD_SHIFT)+j] =
  183. 1024;
  184. ida_hardsizes[(ctlr<<CTLR_SHIFT) + (i<<NWD_SHIFT)+j] =
  185. drv->blk_size;
  186. }
  187. ida_gendisk[ctlr].nr_real++;
  188. }
  190. }
  192. static struct block_device_operations ida_fops  = {
  193. owner: THIS_MODULE,
  194. open: ida_open,
  195. release: ida_release,
  196. ioctl: ida_ioctl,
  197. revalidate: frevalidate_logvol,
  198. };
  201. #ifdef CONFIG_PROC_FS
  203. /*
  204.  * Get us a file in /proc/array that says something about each controller.
  205.  * Create /proc/array if it doesn't exist yet.
  206.  */
  207. static void __init ida_procinit(int i)
  208. {
  209. if (proc_array == NULL) {
  210. proc_array = proc_mkdir("cpqarray", proc_root_driver);
  211. if (!proc_array) return;
  212. }
  214. create_proc_read_entry(hba[i]->devname, 0, proc_array,
  215.        ida_proc_get_info, hba[i]);
  216. }
  218. /*
  219.  * Report information about this controller.
  220.  */
  221. static int ida_proc_get_info(char *buffer, char **start, off_t offset, int length, int *eof, void *data)
  222. {
  223. off_t pos = 0;
  224. off_t len = 0;
  225. int size, i, ctlr;
  226. ctlr_info_t *h = (ctlr_info_t*)data;
  227. drv_info_t *drv;
  228. #ifdef CPQ_PROC_PRINT_QUEUES
  229. cmdlist_t *c;
  230. #endif
  232. ctlr = h->ctlr;
  233. size = sprintf(buffer, "%s:  Compaq %s Controllern"
  234. "       Board ID: 0x%08lxn"
  235. "       Firmware Revision: %c%c%c%cn"
  236. "       Controller Sig: 0x%08lxn"
  237. "       Memory Address: 0x%08lxn"
  238. "       I/O Port: 0x%04xn"
  239. "       IRQ: %dn"
  240. "       Logical drives: %dn"
  241. "       Physical drives: %dnn"
  242. "       Current Q depth: %dn"
  243. "       Max Q depth since init: %dnn",
  244. h->devname, 
  245. h->product_name,
  246. (unsigned long)h->board_id,
  247. h->firm_rev[0], h->firm_rev[1], h->firm_rev[2], h->firm_rev[3],
  248. (unsigned long)h->ctlr_sig, (unsigned long)h->vaddr,
  249. (unsigned int) h->ioaddr, (unsigned int)h->intr,
  250. h->log_drives, h->phys_drives,
  251. h->Qdepth, h->maxQsinceinit);
  253. pos += size; len += size;
  255. size = sprintf(buffer+len, "Logical Drive Info:n");
  256. pos += size; len += size;
  258. for(i=0; i<h->log_drives; i++) {
  259. drv = &h->drv[i];
  260. size = sprintf(buffer+len, "ida/c%dd%d: blksz=%d nr_blks=%dn",
  261. ctlr, i, drv->blk_size, drv->nr_blks);
  262. pos += size; len += size;
  263. }
  265. #ifdef CPQ_PROC_PRINT_QUEUES
  266. size = sprintf(buffer+len, "nCurrent Queues:n");
  267. pos += size; len += size;
  269. c = h->reqQ;
  270. size = sprintf(buffer+len, "reqQ = %p", c); pos += size; len += size;
  271. if (c) c=c->next;
  272. while(c && c != h->reqQ) {
  273. size = sprintf(buffer+len, "->%p", c);
  274. pos += size; len += size;
  275. c=c->next;
  276. }
  278. c = h->cmpQ;
  279. size = sprintf(buffer+len, "ncmpQ = %p", c); pos += size; len += size;
  280. if (c) c=c->next;
  281. while(c && c != h->cmpQ) {
  282. size = sprintf(buffer+len, "->%p", c);
  283. pos += size; len += size;
  284. c=c->next;
  285. }
  287. size = sprintf(buffer+len, "n"); pos += size; len += size;
  288. #endif
  289. size = sprintf(buffer+len, "nr_allocs = %dnnr_frees = %dn",
  290. h->nr_allocs, h->nr_frees);
  291. pos += size; len += size;
  293. *eof = 1;
  294. *start = buffer+offset;
  295. len -= offset;
  296. if (len>length)
  297. len = length;
  298. return len;
  299. }
  300. #endif /* CONFIG_PROC_FS */
  302. #ifdef MODULE
  304. MODULE_PARM(eisa, "1-8i");
  305. EXPORT_NO_SYMBOLS;
  307. /* This is a bit of a hack... */
  308. int __init init_module(void)
  309. {
  310. if (cpqarray_init() == 0) /* all the block dev numbers already used */
  311. return -EIO;   /* or no controllers were found */
  312. return 0;
  313. }
  315. void cleanup_module(void)
  316. {
  317. int i;
  318. char buff[4]; 
  320. for(i=0; i<nr_ctlr; i++) {
  322. /* sendcmd will turn off interrupt, and send the flush... 
  323.  * To write all data in the battery backed cache to disks    
  324.  * no data returned, but don't want to send NULL to sendcmd */
  325. if( sendcmd(FLUSH_CACHE, i, buff, 4, 0, 0, 0))
  326. {
  327. printk(KERN_WARNING "Unable to flush cache on "
  328. "controller %dn", i);
  329. }
  330. free_irq(hba[i]->intr, hba[i]);
  331. iounmap(hba[i]->vaddr);
  332. unregister_blkdev(MAJOR_NR+i, hba[i]->devname);
  333. del_timer(&hba[i]->timer);
  334. blk_cleanup_queue(BLK_DEFAULT_QUEUE(MAJOR_NR + i));
  335. remove_proc_entry(hba[i]->devname, proc_array);
  336. pci_free_consistent(hba[i]->pci_dev, 
  337. NR_CMDS * sizeof(cmdlist_t), (hba[i]->cmd_pool), 
  338. hba[i]->cmd_pool_dhandle);
  339. kfree(hba[i]->cmd_pool_bits);
  341. del_gendisk(&ida_gendisk[i]);
  342. }
  343. devfs_unregister(devfs_find_handle(NULL, "ida", 0, 0, 0, 0));
  344. remove_proc_entry("cpqarray", proc_root_driver);
  345. kfree(ida);
  346. kfree(ida_sizes);
  347. kfree(ida_hardsizes);
  348. kfree(ida_blocksizes);
  349. }
  350. #endif /* MODULE */
  352. static inline int cpq_new_segment(request_queue_t *q, struct request *rq,
  353.   int max_segments)
  354. {
  355. if (rq->nr_segments < SG_MAX) {
  356. rq->nr_segments++;
  357. return 1;
  358. }
  359. return 0;
  360. }
  362. static int cpq_back_merge_fn(request_queue_t *q, struct request *rq,
  363.      struct buffer_head *bh, int max_segments)
  364. {
  365. if (rq->bhtail->b_data + rq->bhtail->b_size == bh->b_data)
  366. return 1;
  367. return cpq_new_segment(q, rq, max_segments);
  368. }
  370. static int cpq_front_merge_fn(request_queue_t *q, struct request *rq,
  371.      struct buffer_head *bh, int max_segments)
  372. {
  373. if (bh->b_data + bh->b_size == rq->bh->b_data)
  374. return 1;
  375. return cpq_new_segment(q, rq, max_segments);
  376. }
  378. static int cpq_merge_requests_fn(request_queue_t *q, struct request *rq,
  379.  struct request *nxt, int max_segments)
  380. {
  381. int total_segments = rq->nr_segments + nxt->nr_segments;
  383. if (rq->bhtail->b_data + rq->bhtail->b_size == nxt->bh->b_data)
  384. total_segments--;
  386. if (total_segments > SG_MAX)
  387. return 0;
  389. rq->nr_segments = total_segments;
  390. return 1;
  391. }
  393. /*
  394.  *  This is it.  Find all the controllers and register them.  I really hate
  395.  *  stealing all these major device numbers.
  396.  *  returns the number of block devices registered.
  397.  */
  398. int __init cpqarray_init(void)
  399. {
  400. request_queue_t *q;
  401. int i,j;
  402. int num_cntlrs_reg = 0;
  404. /* detect controllers */
  405. cpqarray_pci_detect();
  406. cpqarray_eisa_detect();
  408. if (nr_ctlr == 0)
  409. return(num_cntlrs_reg);
  411. printk(DRIVER_NAME "n");
  412. printk("Found %d controller(s)n", nr_ctlr);
  414. /* allocate space for disk structs */
  415. ida = kmalloc(sizeof(struct hd_struct)*nr_ctlr*NWD*16, GFP_KERNEL);
  416. if(ida==NULL)
  417. {
  418. printk( KERN_ERR "cpqarray: out of memory");
  419. return(num_cntlrs_reg);
  420. }
  422. ida_sizes = kmalloc(sizeof(int)*nr_ctlr*NWD*16, GFP_KERNEL);
  423. if(ida_sizes==NULL)
  424. {
  425. kfree(ida); 
  426. printk( KERN_ERR "cpqarray: out of memory");
  427. return(num_cntlrs_reg);
  428. }
  430. ida_blocksizes = kmalloc(sizeof(int)*nr_ctlr*NWD*16, GFP_KERNEL);
  431. if(ida_blocksizes==NULL)
  432. {
  433. kfree(ida);
  434. kfree(ida_sizes); 
  435. printk( KERN_ERR "cpqarray: out of memory");
  436. return(num_cntlrs_reg);
  437. }
  439. ida_hardsizes = kmalloc(sizeof(int)*nr_ctlr*NWD*16, GFP_KERNEL);
  440. if(ida_hardsizes==NULL)
  441. {
  442. kfree(ida);
  443. kfree(ida_sizes); 
  444. kfree(ida_blocksizes);
  445. printk( KERN_ERR "cpqarray: out of memory");
  446. return(num_cntlrs_reg);
  447. }
  449. memset(ida, 0, sizeof(struct hd_struct)*nr_ctlr*NWD*16);
  450. memset(ida_sizes, 0, sizeof(int)*nr_ctlr*NWD*16);
  451. memset(ida_blocksizes, 0, sizeof(int)*nr_ctlr*NWD*16);
  452. memset(ida_hardsizes, 0, sizeof(int)*nr_ctlr*NWD*16);
  453. memset(ida_gendisk, 0, sizeof(struct gendisk)*MAX_CTLR);
  455. /* 
  456.  * register block devices
  457.  * Find disks and fill in structs
  458.  * Get an interrupt, set the Q depth and get into /proc
  459.  */
  460. for(i=0; i< nr_ctlr; i++) {
  461.    /* If this successful it should insure that we are the only */
  462. /* instance of the driver */
  463. if (register_blkdev(MAJOR_NR+i, hba[i]->devname, &ida_fops)) {
  464.                         printk(KERN_ERR "cpqarray: Unable to get major number %d for idan",
  465.                                 MAJOR_NR+i);
  466.                         continue;
  467.                 }
  470. hba[i]->access.set_intr_mask(hba[i], 0);
  471. if (request_irq(hba[i]->intr, do_ida_intr,
  472. SA_INTERRUPT|SA_SHIRQ, hba[i]->devname, hba[i])) {
  474. printk(KERN_ERR "cpqarray: Unable to get irq %d for %sn", 
  475. hba[i]->intr, hba[i]->devname);
  476. unregister_blkdev(MAJOR_NR+i, hba[i]->devname);
  477. continue;
  478. }
  479. num_cntlrs_reg++;
  480. hba[i]->cmd_pool = (cmdlist_t *)pci_alloc_consistent(
  481. hba[i]->pci_dev, NR_CMDS * sizeof(cmdlist_t), 
  482. &(hba[i]->cmd_pool_dhandle));
  483. hba[i]->cmd_pool_bits = (__u32*)kmalloc(
  484. ((NR_CMDS+31)/32)*sizeof(__u32), GFP_KERNEL);
  486. if(hba[i]->cmd_pool_bits == NULL || hba[i]->cmd_pool == NULL)
  487. {
  488. nr_ctlr = i; 
  489. if(hba[i]->cmd_pool_bits)
  490. kfree(hba[i]->cmd_pool_bits);
  491. if(hba[i]->cmd_pool)
  492. pci_free_consistent(hba[i]->pci_dev, 
  493. NR_CMDS * sizeof(cmdlist_t), 
  494. hba[i]->cmd_pool, 
  495. hba[i]->cmd_pool_dhandle);
  496. free_irq(hba[i]->intr, hba[i]);
  497. unregister_blkdev(MAJOR_NR+i, hba[i]->devname);
  498. num_cntlrs_reg--;
  499.                  printk( KERN_ERR "cpqarray: out of memory");
  501. /* If num_cntlrs_reg == 0, no controllers worked. 
  502.  * init_module will fail, so clean up global 
  503.  * memory that clean_module would do.
  504. */
  506. if (num_cntlrs_reg == 0) 
  507. {
  508. kfree(ida);
  509. kfree(ida_sizes);
  510. kfree(ida_hardsizes);
  511. kfree(ida_blocksizes);
  512. }
  513.                  return(num_cntlrs_reg);
  515. }
  516. memset(hba[i]->cmd_pool, 0, NR_CMDS * sizeof(cmdlist_t));
  517. memset(hba[i]->cmd_pool_bits, 0, ((NR_CMDS+31)/32)*sizeof(__u32));
  518. printk(KERN_INFO "cpqarray: Finding drives on %s", 
  519. hba[i]->devname);
  520. getgeometry(i);
  521. start_fwbk(i); 
  523. hba[i]->access.set_intr_mask(hba[i], FIFO_NOT_EMPTY);
  525. ida_procinit(i);
  527. q = BLK_DEFAULT_QUEUE(MAJOR_NR + i);
  528. q->queuedata = hba[i];
  529. blk_init_queue(q, do_ida_request);
  530. blk_queue_headactive(q, 0);
  531. blksize_size[MAJOR_NR+i] = ida_blocksizes + (i*256);
  532. hardsect_size[MAJOR_NR+i] = ida_hardsizes + (i*256);
  533. read_ahead[MAJOR_NR+i] = READ_AHEAD;
  535. q->back_merge_fn = cpq_back_merge_fn;
  536. q->front_merge_fn = cpq_front_merge_fn;
  537. q->merge_requests_fn = cpq_merge_requests_fn;
  539. ida_gendisk[i].major = MAJOR_NR + i;
  540. ida_gendisk[i].major_name = "ida";
  541. ida_gendisk[i].minor_shift = NWD_SHIFT;
  542. ida_gendisk[i].max_p = 16;
  543. ida_gendisk[i].part = ida + (i*256);
  544. ida_gendisk[i].sizes = ida_sizes + (i*256);
  545. ida_gendisk[i].nr_real = 0; 
  546. ida_gendisk[i].de_arr = de_arr[i]; 
  547. ida_gendisk[i].fops = &ida_fops; 
  549. /* Get on the disk list */
  550. add_gendisk(&ida_gendisk[i]);
  552. init_timer(&hba[i]->timer);
  553. hba[i]->timer.expires = jiffies + IDA_TIMER;
  554. hba[i]->timer.data = (unsigned long)hba[i];
  555. hba[i]->timer.function = ida_timer;
  556. add_timer(&hba[i]->timer);
  558. ida_geninit(i);
  559. for(j=0; j<NWD; j++)
  560. register_disk(&ida_gendisk[i], 
  561. MKDEV(MAJOR_NR+i,j<<4),
  562. 16, &ida_fops, hba[i]->drv[j].nr_blks);
  564. }
  565. /* done ! */
  566. return(num_cntlrs_reg);
  567. }
  569. /*
  570.  * Find the controller and initialize it
  571.  *  Cannot use the class code to search, because older array controllers use
  572.  *    0x018000 and new ones use 0x010400.  So I might as well search for each
  573.  *    each device IDs, being there are only going to be three of them. 
  574.  */
  575. static int cpqarray_pci_detect(void)
  576. {
  577. struct pci_dev *pdev;
  579. #define IDA_BOARD_TYPES 3
  580. static int ida_vendor_id[IDA_BOARD_TYPES] = { PCI_VENDOR_ID_DEC, 
  581. PCI_VENDOR_ID_NCR, PCI_VENDOR_ID_COMPAQ };
  582. static int ida_device_id[IDA_BOARD_TYPES] = { PCI_DEVICE_ID_COMPAQ_42XX, PCI_DEVICE_ID_NCR_53C1510, PCI_DEVICE_ID_COMPAQ_SMART2P };
  583. int brdtype;
  585. /* search for all PCI board types that could be for this driver */
  586. for(brdtype=0; brdtype<IDA_BOARD_TYPES; brdtype++)
  587. {
  588. pdev = pci_find_device(ida_vendor_id[brdtype],
  589.        ida_device_id[brdtype], NULL);
  590. while (pdev) {
  591. printk(KERN_DEBUG "cpqarray: Device 0x%x has"
  592. " been found at bus %d dev %d func %dn",
  593. ida_vendor_id[brdtype],
  594. pdev->bus->number, PCI_SLOT(pdev->devfn),
  595. PCI_FUNC(pdev->devfn));
  596. if (nr_ctlr == 8) {
  597. printk(KERN_WARNING "cpqarray: This driver"
  598. " supports a maximum of 8 controllers.n");
  599. break;
  600. }
  602. /* if it is a PCI_DEVICE_ID_NCR_53C1510, make sure it's  the Compaq version of the chip */ 
  604. if (ida_device_id[brdtype] == PCI_DEVICE_ID_NCR_53C1510) {
  605. unsigned short subvendor=pdev->subsystem_vendor;
  606. if(subvendor !=  PCI_VENDOR_ID_COMPAQ)
  607. {
  608. printk(KERN_DEBUG 
  609. "cpqarray: not a Compaq integrated array controllern");
  610. continue;
  611. }
  612. }
  614. hba[nr_ctlr] = kmalloc(sizeof(ctlr_info_t), GFP_KERNEL); if(hba[nr_ctlr]==NULL)
  615. {
  616. printk(KERN_ERR "cpqarray: out of memory.n");
  617. continue;
  618. }
  619. memset(hba[nr_ctlr], 0, sizeof(ctlr_info_t));
  620. if (cpqarray_pci_init(hba[nr_ctlr], pdev) != 0)
  621. {
  622. kfree(hba[nr_ctlr]);
  623. continue;
  624. }
  625. sprintf(hba[nr_ctlr]->devname, "ida%d", nr_ctlr);
  626. hba[nr_ctlr]->ctlr = nr_ctlr;
  627. nr_ctlr++;
  629. pdev = pci_find_device(ida_vendor_id[brdtype],
  630.        ida_device_id[brdtype], pdev);
  631. }
  632. }
  634. return nr_ctlr;
  635. }
  637. /*
  638.  * Find the IO address of the controller, its IRQ and so forth.  Fill
  639.  * in some basic stuff into the ctlr_info_t structure.
  640.  */
  641. static int cpqarray_pci_init(ctlr_info_t *c, struct pci_dev *pdev)
  642. {
  643. ushort vendor_id, device_id, command;
  644. unchar cache_line_size, latency_timer;
  645. unchar irq, revision;
  646. unsigned long addr[6];
  647. __u32 board_id;
  649. int i;
  651. c->pci_dev = pdev;
  652. vendor_id = pdev->vendor;
  653. device_id = pdev->device;
  654. irq = pdev->irq;
  656. for(i=0; i<6; i++)
  657. addr[i] = pci_resource_start(pdev, i);
  659. if (pci_enable_device(pdev))
  660. {
  661. printk(KERN_ERR "cpqarray: Unable to Enable PCI devicen");
  662. return -1;
  663. }
  664. if (pci_set_dma_mask(pdev, CPQARRAY_DMA_MASK) != 0)
  665. {
  666. printk(KERN_ERR "cpqarray: Unable to set DMA maskn");
  667. return -1;
  668. }
  670. pci_read_config_word(pdev, PCI_COMMAND, &command);
  671. pci_read_config_byte(pdev, PCI_CLASS_REVISION, &revision);
  672. pci_read_config_byte(pdev, PCI_CACHE_LINE_SIZE, &cache_line_size);
  673. pci_read_config_byte(pdev, PCI_LATENCY_TIMER, &latency_timer);
  675. pci_read_config_dword(pdev, 0x2c, &board_id);
  677. DBGINFO(
  678. printk("vendor_id = %xn", vendor_id);
  679. printk("device_id = %xn", device_id);
  680. printk("command = %xn", command);
  681. for(i=0; i<6; i++)
  682. printk("addr[%d] = %lxn", i, addr[i]);
  683. printk("revision = %xn", revision);
  684. printk("irq = %xn", irq);
  685. printk("cache_line_size = %xn", cache_line_size);
  686. printk("latency_timer = %xn", latency_timer);
  687. printk("board_id = %xn", board_id);
  688. );
  690. c->intr = irq;
  691. c->ioaddr = addr[0];
  693. c->paddr = 0;
  694. for(i=0; i<6; i++)
  695. if (pci_resource_flags(pdev, i) & IORESOURCE_MEM) {
  696. c->paddr = pci_resource_start (pdev, i);
  697. break;
  698. }
  699. if (!c->paddr)
  700. return -1;
  701. c->vaddr = remap_pci_mem(c->paddr, 128);
  702. if (!c->vaddr)
  703. return -1;
  704. c->board_id = board_id;
  706. for(i=0; i<NR_PRODUCTS; i++) {
  707. if (board_id == products[i].board_id) {
  708. c->product_name = products[i].product_name;
  709. c->access = *(products[i].access);
  710. break;
  711. }
  712. }
  713. if (i == NR_PRODUCTS) {
  714. printk(KERN_WARNING "cpqarray: Sorry, I don't know how"
  715. " to access the SMART Array controller %08lxn", 
  716. (unsigned long)board_id);
  717. return -1;
  718. }
  720. return 0;
  721. }
  723. /*
  724.  * Map (physical) PCI mem into (virtual) kernel space
  725.  */
  726. static void *remap_pci_mem(ulong base, ulong size)
  727. {
  728.         ulong page_base        = ((ulong) base) & PAGE_MASK;
  729.         ulong page_offs        = ((ulong) base) - page_base;
  730.         void *page_remapped    = ioremap(page_base, page_offs+size);
  732.         return (page_remapped ? (page_remapped + page_offs) : NULL);
  733. }
  735. #ifndef MODULE
  736. #if LINUX_VERSION_CODE >= KERNEL_VERSION(2,3,13)
  737. /*
  738.  * Config string is a comma seperated set of i/o addresses of EISA cards.
  739.  */
  740. static int cpqarray_setup(char *str)
  741. {
  742. int i, ints[9];
  744. (void)get_options(str, ARRAY_SIZE(ints), ints);
  746. for(i=0; i<ints[0] && i<8; i++)
  747. eisa[i] = ints[i+1];
  748. return 1;
  749. }
  751. __setup("smart2=", cpqarray_setup);
  753. #else
  755. /*
  756.  * Copy the contents of the ints[] array passed to us by init.
  757.  */
  758. void cpqarray_setup(char *str, int *ints)
  759. {
  760. int i;
  761. for(i=0; i<ints[0] && i<8; i++)
  762. eisa[i] = ints[i+1];
  763. }
  764. #endif
  765. #endif
  767. /*
  768.  * Find an EISA controller's signature.  Set up an hba if we find it.
  769.  */
  770. static int cpqarray_eisa_detect(void)
  771. {
  772. int i=0, j;
  773. __u32 board_id;
  774. int intr;
  776. while(i<8 && eisa[i]) {
  777. if (nr_ctlr == 8) {
  778. printk(KERN_WARNING "cpqarray: This driver supports"
  779. " a maximum of 8 controllers.n");
  780. break;
  781. }
  782. board_id = inl(eisa[i]+0xC80);
  783. for(j=0; j < NR_PRODUCTS; j++)
  784. if (board_id == products[j].board_id) 
  785. break;
  787. if (j == NR_PRODUCTS) {
  788. printk(KERN_WARNING "cpqarray: Sorry, I don't know how"
  789. " to access the SMART Array controller %08lxn",  (unsigned long)board_id);
  790. continue;
  791. }
  792. hba[nr_ctlr] = (ctlr_info_t *) kmalloc(sizeof(ctlr_info_t), GFP_KERNEL);
  793. if(hba[nr_ctlr]==NULL)
  794. {
  795. printk(KERN_ERR "cpqarray: out of memory.n");
  796. continue;
  797. }
  798. memset(hba[nr_ctlr], 0, sizeof(ctlr_info_t));
  799. hba[nr_ctlr]->ioaddr = eisa[i];
  801. /*
  802.  * Read the config register to find our interrupt
  803.  */
  804. intr = inb(eisa[i]+0xCC0) >> 4;
  805. if (intr & 1) intr = 11;
  806. else if (intr & 2) intr = 10;
  807. else if (intr & 4) intr = 14;
  808. else if (intr & 8) intr = 15;
  810. hba[nr_ctlr]->intr = intr;
  811. sprintf(hba[nr_ctlr]->devname, "ida%d", nr_ctlr);
  812. hba[nr_ctlr]->product_name = products[j].product_name;
  813. hba[nr_ctlr]->access = *(products[j].access);
  814. hba[nr_ctlr]->ctlr = nr_ctlr;
  815. hba[nr_ctlr]->board_id = board_id;
  816. hba[nr_ctlr]->pci_dev = NULL; /* not PCI */
  818. DBGINFO(
  819. printk("i = %d, j = %dn", i, j);
  820. printk("irq = %xn", intr);
  821. printk("product name = %sn", products[j].product_name);
  822. printk("board_id = %xn", board_id);
  823. );
  825. nr_ctlr++;
  826. i++;
  827. }
  829. return nr_ctlr;
  830. }
  833. /*
  834.  * Open.  Make sure the device is really there.
  835.  */
  836. static int ida_open(struct inode *inode, struct file *filep)
  837. {
  838. int ctlr = MAJOR(inode->i_rdev) - MAJOR_NR;
  839. int dsk  = MINOR(inode->i_rdev) >> NWD_SHIFT;
  841. DBGINFO(printk("ida_open %x (%x:%x)n", inode->i_rdev, ctlr, dsk) );
  842. if (ctlr > MAX_CTLR || hba[ctlr] == NULL)
  843. return -ENXIO;
  845. if (!suser() && ida_sizes[(ctlr << CTLR_SHIFT) +
  846. MINOR(inode->i_rdev)] == 0)
  847. return -ENXIO;
  849. /*
  850.  * Root is allowed to open raw volume zero even if its not configured
  851.  * so array config can still work.  I don't think I really like this,
  852.  * but I'm already using way to many device nodes to claim another one
  853.  * for "raw controller".
  854.  */
  855. if (suser()
  856. && ida_sizes[(ctlr << CTLR_SHIFT) + MINOR(inode->i_rdev)] == 0 
  857. && MINOR(inode->i_rdev) != 0)
  858. return -ENXIO;
  860. hba[ctlr]->drv[dsk].usage_count++;
  861. hba[ctlr]->usage_count++;
  862. return 0;
  863. }
  865. /*
  866.  * Close.  Sync first.
  867.  */
  868. static int ida_release(struct inode *inode, struct file *filep)
  869. {
  870. int ctlr = MAJOR(inode->i_rdev) - MAJOR_NR;
  871. int dsk  = MINOR(inode->i_rdev) >> NWD_SHIFT;
  873. DBGINFO(printk("ida_release %x (%x:%x)n", inode->i_rdev, ctlr, dsk) );
  875. hba[ctlr]->drv[dsk].usage_count--;
  876. hba[ctlr]->usage_count--;
  877. return 0;
  878. }
  880. /*
  881.  * Enqueuing and dequeuing functions for cmdlists.
  882.  */
  883. static inline void addQ(cmdlist_t **Qptr, cmdlist_t *c)
  884. {
  885. if (*Qptr == NULL) {
  886. *Qptr = c;
  887. c->next = c->prev = c;
  888. } else {
  889. c->prev = (*Qptr)->prev;
  890. c->next = (*Qptr);
  891. (*Qptr)->prev->next = c;
  892. (*Qptr)->prev = c;
  893. }
  894. }
  896. static inline cmdlist_t *removeQ(cmdlist_t **Qptr, cmdlist_t *c)
  897. {
  898. if (c && c->next != c) {
  899. if (*Qptr == c) *Qptr = c->next;
  900. c->prev->next = c->next;
  901. c->next->prev = c->prev;
  902. } else {
  903. *Qptr = NULL;
  904. }
  905. return c;
  906. }
  908. /*
  909.  * Get a request and submit it to the controller.
  910.  * This routine needs to grab all the requests it possibly can from the
  911.  * req Q and submit them.  Interrupts are off (and need to be off) when you
  912.  * are in here (either via the dummy do_ida_request functions or by being
  913.  * called from the interrupt handler
  914.  */
  915. static void do_ida_request(request_queue_t *q)
  916. {
  917. ctlr_info_t *h = q->queuedata;
  918. cmdlist_t *c;
  919. char *lastdataend;
  920. struct list_head * queue_head = &q->queue_head;
  921. struct buffer_head *bh;
  922. struct request *creq;
  923. struct my_sg tmp_sg[SG_MAX];
  924. int i, seg;
  926. if (q->plugged)
  927. goto startio;
  929. queue_next:
  930. if (list_empty(queue_head))
  931. goto startio;
  933. creq = blkdev_entry_next_request(queue_head);
  934. if (creq->nr_segments > SG_MAX)
  935. BUG();
  937. if (h->ctlr != MAJOR(creq->rq_dev)-MAJOR_NR || h->ctlr > nr_ctlr)
  938. {
  939. printk(KERN_WARNING "doreq cmd for %d, %x at %pn",
  940. h->ctlr, creq->rq_dev, creq);
  941. blkdev_dequeue_request(creq);
  942. complete_buffers(creq->bh, 0);
  943. end_that_request_last(creq);
  944. goto startio;
  945. }
  947. if ((c = cmd_alloc(h,1)) == NULL)
  948. goto startio;
  950. blkdev_dequeue_request(creq);
  952. spin_unlock_irq(&io_request_lock);
  954. bh = creq->bh;
  956. c->ctlr = h->ctlr;
  957. c->hdr.unit = MINOR(creq->rq_dev) >> NWD_SHIFT;
  958. c->hdr.size = sizeof(rblk_t) >> 2;
  959. c->size += sizeof(rblk_t);
  961. c->req.hdr.blk = ida[(h->ctlr<<CTLR_SHIFT) + MINOR(creq->rq_dev)].start_sect + creq->sector;
  962. c->rq = creq;
  963. DBGPX(
  964. if (bh == NULL)
  965. panic("bh == NULL?");
  967. printk("sector=%d, nr_sectors=%dn", creq->sector, creq->nr_sectors);
  968. );
  969. seg = 0; lastdataend = NULL;
  970. while(bh) {
  971. if (bh->b_data == lastdataend) {
  972. tmp_sg[seg-1].size += bh->b_size;
  973. lastdataend += bh->b_size;
  974. } else {
  975. if (seg == SG_MAX)
  976. BUG();
  977. tmp_sg[seg].size = bh->b_size;
  978. tmp_sg[seg].start_addr = bh->b_data;
  979. lastdataend = bh->b_data + bh->b_size;
  980. seg++;
  981. }
  982. bh = bh->b_reqnext;
  983. }
  984. /* Now do all the DMA Mappings */
  985. for( i=0; i < seg; i++)
  986. {
  987. c->req.sg[i].size = tmp_sg[i].size;
  988. c->req.sg[i].addr = (__u32) pci_map_single(
  989.                  h->pci_dev, tmp_sg[i].start_addr, 
  990. tmp_sg[i].size,
  991.                                 (creq->cmd == READ) ? 
  992. PCI_DMA_FROMDEVICE : PCI_DMA_TODEVICE);
  993. }
  994. DBGPX( printk("Submitting %d sectors in %d segmentsn", sect, seg); );
  995. c->req.hdr.sg_cnt = seg;
  996. c->req.hdr.blk_cnt = creq->nr_sectors;
  997. c->req.hdr.cmd = (creq->cmd == READ) ? IDA_READ : IDA_WRITE;
  998. c->type = CMD_RWREQ;
  1000. spin_lock_irq(&io_request_lock);
  1002. /* Put the request on the tail of the request queue */
  1003. addQ(&h->reqQ, c);
  1004. h->Qdepth++;
  1005. if (h->Qdepth > h->maxQsinceinit) 
  1006. h->maxQsinceinit = h->Qdepth;
  1008. goto queue_next;
  1010. startio:
  1011. start_io(h);
  1012. }
  1014. /* 
  1015.  * start_io submits everything on a controller's request queue
  1016.  * and moves it to the completion queue.
  1017.  *
  1018.  * Interrupts had better be off if you're in here
  1019.  */
  1020. static void start_io(ctlr_info_t *h)
  1021. {
  1022. cmdlist_t *c;
  1024. while((c = h->reqQ) != NULL) {
  1025. /* Can't do anything if we're busy */
  1026. if (h->access.fifo_full(h) == 0)
  1027. return;
  1029. /* Get the first entry from the request Q */
  1030. removeQ(&h->reqQ, c);
  1031. h->Qdepth--;
  1033. /* Tell the controller to do our bidding */
  1034. h->access.submit_command(h, c);
  1036. /* Get onto the completion Q */
  1037. addQ(&h->cmpQ, c);
  1038. }
  1039. }
  1041. static inline void complete_buffers(struct buffer_head *bh, int ok)
  1042. {
  1043. struct buffer_head *xbh;
  1044. while(bh) {
  1045. xbh = bh->b_reqnext;
  1046. bh->b_reqnext = NULL;
  1048. blk_finished_io(bh->b_size >> 9);
  1049. bh->b_end_io(bh, ok);
  1051. bh = xbh;
  1052. }
  1053. }
  1054. /*
  1055.  * Mark all buffers that cmd was responsible for
  1056.  */
  1057. static inline void complete_command(cmdlist_t *cmd, int timeout)
  1058. {
  1059. int ok=1;
  1060. int i;
  1062. if (cmd->req.hdr.rcode & RCODE_NONFATAL &&
  1063.    (hba[cmd->ctlr]->misc_tflags & MISC_NONFATAL_WARN) == 0) {
  1064. printk(KERN_NOTICE "Non Fatal error on ida/c%dd%dn",
  1065. cmd->ctlr, cmd->hdr.unit);
  1066. hba[cmd->ctlr]->misc_tflags |= MISC_NONFATAL_WARN;
  1067. }
  1068. if (cmd->req.hdr.rcode & RCODE_FATAL) {
  1069. printk(KERN_WARNING "Fatal error on ida/c%dd%dn",
  1070. cmd->ctlr, cmd->hdr.unit);
  1071. ok = 0;
  1072. }
  1073. if (cmd->req.hdr.rcode & RCODE_INVREQ) {
  1074. printk(KERN_WARNING "Invalid request on ida/c%dd%d = (cmd=%x sect=%d cnt=%d sg=%d ret=%x)n",
  1075. cmd->ctlr, cmd->hdr.unit, cmd->req.hdr.cmd,
  1076. cmd->req.hdr.blk, cmd->req.hdr.blk_cnt,
  1077. cmd->req.hdr.sg_cnt, cmd->req.hdr.rcode);
  1078. ok = 0;
  1079. }
  1080. if (timeout) ok = 0;
  1081. /* unmap the DMA mapping for all the scatter gather elements */
  1082.         for(i=0; i<cmd->req.hdr.sg_cnt; i++)
  1083.         {
  1084.                 pci_unmap_single(hba[cmd->ctlr]->pci_dev,
  1085.                         cmd->req.sg[i].addr, cmd->req.sg[i].size,
  1086.                         (cmd->req.hdr.cmd == IDA_READ) ? PCI_DMA_FROMDEVICE : PCI_DMA_TODEVICE);
  1087.         }
  1089. complete_buffers(cmd->rq->bh, ok);
  1091. DBGPX(printk("Done with %pn", cmd->rq););
  1092. end_that_request_last(cmd->rq);
  1095. }
  1097. /*
  1098.  *  The controller will interrupt us upon completion of commands.
  1099.  *  Find the command on the completion queue, remove it, tell the OS and
  1100.  *  try to queue up more IO
  1101.  */
  1102. static void do_ida_intr(int irq, void *dev_id, struct pt_regs *regs)
  1103. {
  1104. ctlr_info_t *h = dev_id;
  1105. cmdlist_t *c;
  1106. unsigned long istat;
  1107. unsigned long flags;
  1108. __u32 a,a1;
  1110. istat = h->access.intr_pending(h);
  1111. /* Is this interrupt for us? */
  1112. if (istat == 0)
  1113. return;
  1115. /*
  1116.  * If there are completed commands in the completion queue,
  1117.  * we had better do something about it.
  1118.  */
  1119. spin_lock_irqsave(&io_request_lock, flags);
  1120. if (istat & FIFO_NOT_EMPTY) {
  1121. while((a = h->access.command_completed(h))) {
  1122. a1 = a; a &= ~3;
  1123. if ((c = h->cmpQ) == NULL)
  1124. {  
  1125. printk(KERN_WARNING "cpqarray: Completion of %08lx ignoredn", (unsigned long)a1);
  1126. continue;
  1127. } 
  1128. while(c->busaddr != a) {
  1129. c = c->next;
  1130. if (c == h->cmpQ) 
  1131. break;
  1132. }
  1133. /*
  1134.  * If we've found the command, take it off the
  1135.  * completion Q and free it
  1136.  */
  1137. if (c->busaddr == a) {
  1138. removeQ(&h->cmpQ, c);
  1139. /*  Check for invalid command.
  1140.                                  *  Controller returns command error,
  1141.                                  *  But rcode = 0.
  1142.                                  */
  1144. if((a1 & 0x03) && (c->req.hdr.rcode == 0))
  1145.                                 {
  1146.                                  c->req.hdr.rcode = RCODE_INVREQ;
  1147.                                 }
  1148. if (c->type == CMD_RWREQ) {
  1149. complete_command(c, 0);
  1150. cmd_free(h, c, 1);
  1151. } else if (c->type == CMD_IOCTL_PEND) {
  1152. c->type = CMD_IOCTL_DONE;
  1153. }
  1154. continue;
  1155. }
  1156. }
  1157. }
  1159. /*
  1160.  * See if we can queue up some more IO
  1161.  */
  1162. do_ida_request(BLK_DEFAULT_QUEUE(MAJOR_NR + h->ctlr));
  1163. spin_unlock_irqrestore(&io_request_lock, flags);
  1164. }
  1166. /*
  1167.  * This timer was for timing out requests that haven't happened after
  1168.  * IDA_TIMEOUT.  That wasn't such a good idea.  This timer is used to
  1169.  * reset a flags structure so we don't flood the user with
  1170.  * "Non-Fatal error" messages.
  1171.  */
  1172. static void ida_timer(unsigned long tdata)
  1173. {
  1174. ctlr_info_t *h = (ctlr_info_t*)tdata;
  1176. h->timer.expires = jiffies + IDA_TIMER;
  1177. add_timer(&h->timer);
  1178. h->misc_tflags = 0;
  1179. }
  1181. /*
  1182.  *  ida_ioctl does some miscellaneous stuff like reporting drive geometry,
  1183.  *  setting readahead and submitting commands from userspace to the controller.
  1184.  */
  1185. static int ida_ioctl(struct inode *inode, struct file *filep, unsigned int cmd, unsigned long arg)
  1186. {
  1187. int ctlr = MAJOR(inode->i_rdev) - MAJOR_NR;
  1188. int dsk  = MINOR(inode->i_rdev) >> NWD_SHIFT;
  1189. int error;
  1190. int diskinfo[4];
  1191. struct hd_geometry *geo = (struct hd_geometry *)arg;
  1192. ida_ioctl_t *io = (ida_ioctl_t*)arg;
  1193. ida_ioctl_t my_io;
  1195. switch(cmd) {
  1196. case HDIO_GETGEO:
  1197. if (hba[ctlr]->drv[dsk].cylinders) {
  1198. diskinfo[0] = hba[ctlr]->drv[dsk].heads;
  1199. diskinfo[1] = hba[ctlr]->drv[dsk].sectors;
  1200. diskinfo[2] = hba[ctlr]->drv[dsk].cylinders;
  1201. } else {
  1202. diskinfo[0] = 0xff;
  1203. diskinfo[1] = 0x3f;
  1204. diskinfo[2] = hba[ctlr]->drv[dsk].nr_blks / (0xff*0x3f);
  1205. }
  1206. put_user(diskinfo[0], &geo->heads);
  1207. put_user(diskinfo[1], &geo->sectors);
  1208. put_user(diskinfo[2], &geo->cylinders);
  1209. put_user(ida[(ctlr<<CTLR_SHIFT)+MINOR(inode->i_rdev)].start_sect, &geo->start);
  1210. return 0;
  1211. case IDAGETDRVINFO:
  1212. return copy_to_user(&io->c.drv,&hba[ctlr]->drv[dsk],sizeof(drv_info_t));
  1213. case BLKGETSIZE:
  1214. return put_user(ida[(ctlr<<CTLR_SHIFT)+MINOR(inode->i_rdev)].nr_sects, (unsigned long *)arg);
  1215. case BLKGETSIZE64:
  1216. return put_user((u64)(ida[(ctlr<<CTLR_SHIFT)+MINOR(inode->i_rdev)].nr_sects) << 9, (u64*)arg);
  1217. case BLKRRPART:
  1218. return revalidate_logvol(inode->i_rdev, 1);
  1219. case IDAPASSTHRU:
  1220. if (!suser()) return -EPERM;
  1221. error = copy_from_user(&my_io, io, sizeof(my_io));
  1222. if (error) return error;
  1223. error = ida_ctlr_ioctl(ctlr, dsk, &my_io);
  1224. if (error) return error;
  1225. error = copy_to_user(io, &my_io, sizeof(my_io));
  1226. return error;
  1227. case IDAGETCTLRSIG:
  1228. if (!arg) return -EINVAL;
  1229. put_user(hba[ctlr]->ctlr_sig, (int*)arg);
  1230. return 0;
  1231. case IDAREVALIDATEVOLS:
  1232. return revalidate_allvol(inode->i_rdev);
  1233. case IDADRIVERVERSION:
  1234. if (!arg) return -EINVAL;
  1235. put_user(DRIVER_VERSION, (unsigned long*)arg);
  1236. return 0;
  1237. case IDAGETPCIINFO:
  1238. {
  1240. ida_pci_info_struct pciinfo;
  1242. if (!arg) return -EINVAL;
  1243. pciinfo.bus = hba[ctlr]->pci_dev->bus->number;
  1244. pciinfo.dev_fn = hba[ctlr]->pci_dev->devfn;
  1245. pciinfo.board_id = hba[ctlr]->board_id;
  1246. if(copy_to_user((void *) arg, &pciinfo,  
  1247. sizeof( ida_pci_info_struct)))
  1248. return -EFAULT;
  1249. return(0);
  1250. }
  1252. case BLKFLSBUF:
  1253. case BLKBSZSET:
  1254. case BLKBSZGET:
  1255. case BLKROSET:
  1256. case BLKROGET:
  1257. case BLKRASET:
  1258. case BLKRAGET:
  1259. case BLKELVGET:
  1260. case BLKELVSET:
  1261. case BLKPG:
  1262. return blk_ioctl(inode->i_rdev, cmd, arg);
  1264. default:
  1265. return -EINVAL;
  1266. }
  1268. }
  1269. /*
  1270.  * ida_ctlr_ioctl is for passing commands to the controller from userspace.
  1271.  * The command block (io) has already been copied to kernel space for us,
  1272.  * however, any elements in the sglist need to be copied to kernel space
  1273.  * or copied back to userspace.
  1274.  *
  1275.  * Only root may perform a controller passthru command, however I'm not doing
  1276.  * any serious sanity checking on the arguments.  Doing an IDA_WRITE_MEDIA and
  1277.  * putting a 64M buffer in the sglist is probably a *bad* idea.
  1278.  */
  1279. static int ida_ctlr_ioctl(int ctlr, int dsk, ida_ioctl_t *io)
  1280. {
  1281. ctlr_info_t *h = hba[ctlr];
  1282. cmdlist_t *c;
  1283. void *p = NULL;
  1284. unsigned long flags;
  1285. int error;
  1287. if ((c = cmd_alloc(h, 0)) == NULL)
  1288. return -ENOMEM;
  1289. c->ctlr = ctlr;
  1290. c->hdr.unit = (io->unit & UNITVALID) ? (io->unit & ~UNITVALID) : dsk;
  1291. c->hdr.size = sizeof(rblk_t) >> 2;
  1292. c->size += sizeof(rblk_t);
  1294. c->req.hdr.cmd = io->cmd;
  1295. c->req.hdr.blk = io->blk;
  1296. c->req.hdr.blk_cnt = io->blk_cnt;
  1297. c->type = CMD_IOCTL_PEND;
  1299. /* Pre submit processing */
  1300. switch(io->cmd) {
  1301. case PASSTHRU_A:
  1302. p = kmalloc(io->sg[0].size, GFP_KERNEL);
  1303. if (!p) 
  1304. { 
  1305. error = -ENOMEM; 
  1306. cmd_free(h, c, 0); 
  1307. return(error);
  1308. }
  1309. copy_from_user(p, (void*)io->sg[0].addr, io->sg[0].size);
  1310. c->req.hdr.blk = pci_map_single(h->pci_dev, &(io->c), 
  1311. sizeof(ida_ioctl_t), 
  1312. PCI_DMA_BIDIRECTIONAL);
  1313. c->req.sg[0].size = io->sg[0].size;
  1314. c->req.sg[0].addr = pci_map_single(h->pci_dev, p, 
  1315. c->req.sg[0].size, PCI_DMA_BIDIRECTIONAL);
  1316. c->req.hdr.sg_cnt = 1;
  1317. break;
  1318. case IDA_READ:
  1319. case READ_FLASH_ROM:
  1320. case SENSE_CONTROLLER_PERFORMANCE:
  1321. p = kmalloc(io->sg[0].size, GFP_KERNEL);
  1322. if (!p) 
  1323. { 
  1324.                         error = -ENOMEM; 
  1325.                         cmd_free(h, c, 0);
  1326.                         return(error);
  1327.                 }
  1329. c->req.sg[0].size = io->sg[0].size;
  1330. c->req.sg[0].addr = pci_map_single(h->pci_dev, p, 
  1331. c->req.sg[0].size, PCI_DMA_BIDIRECTIONAL); 
  1332. c->req.hdr.sg_cnt = 1;
  1333. break;
  1334. case IDA_WRITE:
  1335. case IDA_WRITE_MEDIA:
  1336. case DIAG_PASS_THRU:
  1337. case COLLECT_BUFFER:
  1338. case WRITE_FLASH_ROM:
  1339. p = kmalloc(io->sg[0].size, GFP_KERNEL);
  1340. if (!p) 
  1341.   { 
  1342.                         error = -ENOMEM; 
  1343.                         cmd_free(h, c, 0);
  1344.                         return(error);
  1345.                 }
  1346. copy_from_user(p, (void*)io->sg[0].addr, io->sg[0].size);
  1347. c->req.sg[0].size = io->sg[0].size;
  1348. c->req.sg[0].addr = pci_map_single(h->pci_dev, p, 
  1349. c->req.sg[0].size, PCI_DMA_BIDIRECTIONAL); 
  1350. c->req.hdr.sg_cnt = 1;
  1351. break;
  1352. default:
  1353. c->req.sg[0].size = sizeof(io->c);
  1354. c->req.sg[0].addr = pci_map_single(h->pci_dev,&io->c, 
  1355. c->req.sg[0].size, PCI_DMA_BIDIRECTIONAL);
  1356. c->req.hdr.sg_cnt = 1;
  1357. }
  1359. /* Put the request on the tail of the request queue */
  1360. spin_lock_irqsave(&io_request_lock, flags);
  1361. addQ(&h->reqQ, c);
  1362. h->Qdepth++;
  1363. start_io(h);
  1364. spin_unlock_irqrestore(&io_request_lock, flags);
  1366. /* Wait for completion */
  1367. while(c->type != CMD_IOCTL_DONE)
  1368. schedule();
  1370. /* Unmap the DMA  */
  1371. pci_unmap_single(h->pci_dev, c->req.sg[0].addr, c->req.sg[0].size, 
  1372. PCI_DMA_BIDIRECTIONAL);
  1373. /* Post submit processing */
  1374. switch(io->cmd) {
  1375. case PASSTHRU_A:
  1376. pci_unmap_single(h->pci_dev, c->req.hdr.blk,
  1377.                                 sizeof(ida_ioctl_t),
  1378.                                 PCI_DMA_BIDIRECTIONAL);
  1379. case IDA_READ:
  1380. case DIAG_PASS_THRU:
  1381. case SENSE_CONTROLLER_PERFORMANCE:
  1382. case READ_FLASH_ROM:
  1383. copy_to_user((void*)io->sg[0].addr, p, io->sg[0].size);
  1384. /* fall through and free p */
  1385. case IDA_WRITE:
  1386. case IDA_WRITE_MEDIA:
  1387. case COLLECT_BUFFER:
  1388. case WRITE_FLASH_ROM:
  1389. kfree(p);
  1390. break;
  1391. default:;
  1392. /* Nothing to do */
  1393. }
  1395. io->rcode = c->req.hdr.rcode;
  1396. cmd_free(h, c, 0);
  1397. return(0);
  1398. }
  1400. /*
  1401.  * Commands are pre-allocated in a large block.  Here we use a simple bitmap
  1402.  * scheme to suballocte them to the driver.  Operations that are not time
  1403.  * critical (and can wait for kmalloc and possibly sleep) can pass in NULL
  1404.  * as the first argument to get a new command.
  1405.  */
  1406. static cmdlist_t * cmd_alloc(ctlr_info_t *h, int get_from_pool)
  1407. {
  1408. cmdlist_t * c;
  1409. int i;
  1410. dma_addr_t cmd_dhandle;
  1412. if (!get_from_pool) {
  1413. c = (cmdlist_t*)pci_alloc_consistent(h->pci_dev, 
  1414. sizeof(cmdlist_t), &cmd_dhandle);
  1415. if(c==NULL)
  1416. return NULL;
  1417. } else {
  1418. do {
  1419. i = find_first_zero_bit(h->cmd_pool_bits, NR_CMDS);
  1420. if (i == NR_CMDS)
  1421. return NULL;
  1422. } while(test_and_set_bit(i%32, h->cmd_pool_bits+(i/32)) != 0);
  1423. c = h->cmd_pool + i;
  1424. cmd_dhandle = h->cmd_pool_dhandle + i*sizeof(cmdlist_t);
  1425. h->nr_allocs++;
  1426. }
  1428. memset(c, 0, sizeof(cmdlist_t));
  1429. c->busaddr = cmd_dhandle; 
  1430. return c;
  1431. }
  1433. static void cmd_free(ctlr_info_t *h, cmdlist_t *c, int got_from_pool)
  1434. {
  1435. int i;
  1437. if (!got_from_pool) {
  1438. pci_free_consistent(h->pci_dev, sizeof(cmdlist_t), c,
  1439. c->busaddr);
  1440. } else {
  1441. i = c - h->cmd_pool;
  1442. clear_bit(i%32, h->cmd_pool_bits+(i/32));
  1443. h->nr_frees++;
  1444. }
  1445. }
  1447. /***********************************************************************
  1448.     name:        sendcmd
  1449.     Send a command to an IDA using the memory mapped FIFO interface
  1450.     and wait for it to complete.  
  1451.     This routine should only be called at init time.
  1452. ***********************************************************************/
  1453. static int sendcmd(
  1454. __u8 cmd,
  1455. int ctlr,
  1456. void *buff,
  1457. size_t size,
  1458. unsigned int blk,
  1459. unsigned int blkcnt,
  1460. unsigned int log_unit )
  1461. {
  1462. cmdlist_t *c;
  1463. int complete;
  1464. unsigned long temp;
  1465. unsigned long i;
  1466. ctlr_info_t *info_p = hba[ctlr];
  1468. c = cmd_alloc(info_p, 1);
  1469. if(!c)
  1470. return IO_ERROR;
  1471. c->ctlr = ctlr;
  1472. c->hdr.unit = log_unit;
  1473. c->hdr.prio = 0;
  1474. c->hdr.size = sizeof(rblk_t) >> 2;
  1475. c->size += sizeof(rblk_t);
  1477. /* The request information. */
  1478. c->req.hdr.next = 0;
  1479. c->req.hdr.rcode = 0;
  1480. c->req.bp = 0;
  1481. c->req.hdr.sg_cnt = 1;
  1482. c->req.hdr.reserved = 0;
  1484. if (size == 0)
  1485. c->req.sg[0].size = 512;
  1486. else
  1487. c->req.sg[0].size = size;
  1489. c->req.hdr.blk = blk;
  1490. c->req.hdr.blk_cnt = blkcnt;
  1491. c->req.hdr.cmd = (unsigned char) cmd;
  1492. c->req.sg[0].addr = (__u32) pci_map_single(info_p->pci_dev, 
  1493. buff, c->req.sg[0].size, PCI_DMA_BIDIRECTIONAL);
  1494. /*
  1495.  * Disable interrupt
  1496.  */
  1497. info_p->access.set_intr_mask(info_p, 0);
  1498. /* Make sure there is room in the command FIFO */
  1499. /* Actually it should be completely empty at this time. */
  1500. for (i = 200000; i > 0; i--) {
  1501. temp = info_p->access.fifo_full(info_p);
  1502. if (temp != 0) {
  1503. break;
  1504. }
  1505. udelay(10);
  1506. DBG(
  1507. printk(KERN_WARNING "cpqarray ida%d: idaSendPciCmd FIFO full,"
  1508. " waiting!n", ctlr);
  1509. );
  1510. } 
  1511. /*
  1512.  * Send the cmd
  1513.  */
  1514. info_p->access.submit_command(info_p, c);
  1515. complete = pollcomplete(ctlr);
  1517. pci_unmap_single(info_p->pci_dev, (dma_addr_t) c->req.sg[0].addr, 
  1518. c->req.sg[0].size, PCI_DMA_BIDIRECTIONAL);
  1519. if (complete != 1) {
  1520. if (complete != c->busaddr) {
  1521. printk( KERN_WARNING
  1522. "cpqarray ida%d: idaSendPciCmd "
  1523.       "Invalid command list address returned! (%08lx)n",
  1524. ctlr, (unsigned long)complete);
  1525. cmd_free(info_p, c, 1);
  1526. return (IO_ERROR);
  1527. }
  1528. } else {
  1529. printk( KERN_WARNING
  1530. "cpqarray ida%d: idaSendPciCmd Timeout out, "
  1531. "No command list address returned!n",
  1532. ctlr);
  1533. cmd_free(info_p, c, 1);
  1534. return (IO_ERROR);
  1535. }
  1537. if (c->req.hdr.rcode & 0x00FE) {
  1538. if (!(c->req.hdr.rcode & BIG_PROBLEM)) {
  1539. printk( KERN_WARNING
  1540. "cpqarray ida%d: idaSendPciCmd, error: "
  1541. "Controller failed at init time "
  1542. "cmd: 0x%x, return code = 0x%xn",
  1543. ctlr, c->req.hdr.cmd, c->req.hdr.rcode);
  1545. cmd_free(info_p, c, 1);
  1546. return (IO_ERROR);
  1547. }
  1548. }
  1549. cmd_free(info_p, c, 1);
  1550. return (IO_OK);
  1551. }
  1553. static int frevalidate_logvol(kdev_t dev)
  1554. {
  1555. return revalidate_logvol(dev, 0);
  1556. }
  1558. /*
  1559.  * revalidate_allvol is for online array config utilities.  After a
  1560.  * utility reconfigures the drives in the array, it can use this function
  1561.  * (through an ioctl) to make the driver zap any previous disk structs for
  1562.  * that controller and get new ones.
  1563.  *
  1564.  * Right now I'm using the getgeometry() function to do this, but this
  1565.  * function should probably be finer grained and allow you to revalidate one
  1566.  * particualar logical volume (instead of all of them on a particular
  1567.  * controller).
  1568.  */
  1569. static int revalidate_allvol(kdev_t dev)
  1570. {
  1571. int ctlr, i;
  1572. unsigned long flags;
  1574. ctlr = MAJOR(dev) - MAJOR_NR;
  1575. if (MINOR(dev) != 0)
  1576. return -ENXIO;
  1578. spin_lock_irqsave(&io_request_lock, flags);
  1579. if (hba[ctlr]->usage_count > 1) {
  1580. spin_unlock_irqrestore(&io_request_lock, flags);
  1581. printk(KERN_WARNING "cpqarray: Device busy for volume"
  1582. " revalidation (usage=%d)n", hba[ctlr]->usage_count);
  1583. return -EBUSY;
  1584. }
  1585. spin_unlock_irqrestore(&io_request_lock, flags);
  1586. hba[ctlr]->usage_count++;
  1588. /*
  1589.  * Set the partition and block size structures for all volumes
  1590.  * on this controller to zero.  We will reread all of this data
  1591.  */
  1592. memset(ida+(ctlr*256),            0, sizeof(struct hd_struct)*NWD*16);
  1593. memset(ida_sizes+(ctlr*256),      0, sizeof(int)*NWD*16);
  1594. memset(ida_blocksizes+(ctlr*256), 0, sizeof(int)*NWD*16);
  1595. memset(ida_hardsizes+(ctlr*256),  0, sizeof(int)*NWD*16);
  1596. memset(hba[ctlr]->drv,            0, sizeof(drv_info_t)*NWD);
  1597. ida_gendisk[ctlr].nr_real = 0;
  1599. /*
  1600.  * Tell the array controller not to give us any interrupts while
  1601.  * we check the new geometry.  Then turn interrupts back on when
  1602.  * we're done.
  1603.  */
  1604. hba[ctlr]->access.set_intr_mask(hba[ctlr], 0);
  1605. getgeometry(ctlr);
  1606. hba[ctlr]->access.set_intr_mask(hba[ctlr], FIFO_NOT_EMPTY);
  1608. ida_geninit(ctlr);
  1609. for(i=0; i<NWD; i++)
  1610. if (ida_sizes[(ctlr<<CTLR_SHIFT) + (i<<NWD_SHIFT)])
  1611. revalidate_logvol(dev+(i<<NWD_SHIFT), 2);
  1613. hba[ctlr]->usage_count--;
  1614. return 0;
  1615. }
  1617. /* Borrowed and adapted from sd.c */
  1618. static int revalidate_logvol(kdev_t dev, int maxusage)
  1619. {
  1620. int ctlr, target;
  1621. struct gendisk *gdev;
  1622. unsigned long flags;
  1623. int max_p;
  1624. int start;
  1625. int i;
  1627. target = DEVICE_NR(dev);
  1628. ctlr = MAJOR(dev) - MAJOR_NR;
  1629. gdev = &ida_gendisk[ctlr];
  1631. spin_lock_irqsave(&io_request_lock, flags);
  1632. if (hba[ctlr]->drv[target].usage_count > maxusage) {
  1633. spin_unlock_irqrestore(&io_request_lock, flags);
  1634. printk(KERN_WARNING "cpqarray: Device busy for "
  1635. "revalidation (usage=%d)n",
  1636. hba[ctlr]->drv[target].usage_count);
  1637. return -EBUSY;
  1638. }
  1640. hba[ctlr]->drv[target].usage_count++;
  1641. spin_unlock_irqrestore(&io_request_lock, flags);
  1643. max_p = gdev->max_p;
  1644. start = target << gdev->minor_shift;
  1646. for(i=max_p-1; i>=0; i--) {
  1647. int minor = start+i;
  1648. invalidate_device(MKDEV(MAJOR_NR + ctlr, minor), 1);
  1649. gdev->part[minor].start_sect = 0;
  1650. gdev->part[minor].nr_sects = 0;
  1652. /* reset the blocksize so we can read the partition table */
  1653. blksize_size[MAJOR_NR+ctlr][minor] = 1024;
  1654. }
  1656. /* 16 minors per disk... */
  1657. grok_partitions(gdev, target, 16, hba[ctlr]->drv[target].nr_blks);
  1658. hba[ctlr]->drv[target].usage_count--;
  1659. return 0;
  1660. }
  1663. /********************************************************************
  1664.     name: pollcomplete
  1665.     Wait polling for a command to complete.
  1666.     The memory mapped FIFO is polled for the completion.
  1667.     Used only at init time, interrupts disabled.
  1668.  ********************************************************************/
  1669. static int pollcomplete(int ctlr)
  1670. {
  1671. int done;
  1672. int i;
  1674. /* Wait (up to 2 seconds) for a command to complete */
  1676. for (i = 200000; i > 0; i--) {
  1677. done = hba[ctlr]->access.command_completed(hba[ctlr]);
  1678. if (done == 0) {
  1679. udelay(10); /* a short fixed delay */
  1680. } else
  1681. return (done);
  1682. }
  1683. /* Invalid address to tell caller we ran out of time */
  1684. return 1;
  1685. }
  1686. /*****************************************************************
  1687.     start_fwbk
  1688.     Starts controller firmwares background processing. 
  1689.     Currently only the Integrated Raid controller needs this done.
  1690.     If the PCI mem address registers are written to after this, 
  1691.  data corruption may occur
  1692. *****************************************************************/
  1693. static void start_fwbk(int ctlr)
  1694. {
  1695. id_ctlr_t *id_ctlr_buf; 
  1696. int ret_code;
  1698. if( (hba[ctlr]->board_id != 0x40400E11)
  1699. && (hba[ctlr]->board_id != 0x40480E11) )
  1701. /* Not a Integrated Raid, so there is nothing for us to do */
  1702. return;
  1703. printk(KERN_DEBUG "cpqarray: Starting firmware's background"
  1704. " processingn");
  1705. /* Command does not return anything, but idasend command needs a 
  1706. buffer */
  1707. id_ctlr_buf = (id_ctlr_t *)kmalloc(sizeof(id_ctlr_t), GFP_KERNEL);
  1708. if(id_ctlr_buf==NULL)
  1709. {
  1710. printk(KERN_WARNING "cpqarray: Out of memory. "
  1711. "Unable to start background processing.n");
  1712. return;
  1713. }
  1714. ret_code = sendcmd(RESUME_BACKGROUND_ACTIVITY, ctlr, 
  1715. id_ctlr_buf, 0, 0, 0, 0);
  1716. if(ret_code != IO_OK)
  1717. printk(KERN_WARNING "cpqarray: Unable to start"
  1718. " background processingn");
  1720. kfree(id_ctlr_buf);
  1721. }
  1722. /*****************************************************************
  1723.     getgeometry
  1724.     Get ida logical volume geometry from the controller 
  1725.     This is a large bit of code which once existed in two flavors,
  1726.     It is used only at init time.
  1727. *****************************************************************/
  1728. static void getgeometry(int ctlr)
  1729. {
  1730. id_log_drv_t *id_ldrive;
  1731. id_ctlr_t *id_ctlr_buf;
  1732. sense_log_drv_stat_t *id_lstatus_buf;
  1733. config_t *sense_config_buf;
  1734. unsigned int log_unit, log_index;
  1735. int ret_code, size;
  1736. drv_info_t *drv;
  1737. ctlr_info_t *info_p = hba[ctlr];
  1738. int i;
  1740. info_p->log_drv_map = 0;
  1742. id_ldrive = (id_log_drv_t *)kmalloc(sizeof(id_log_drv_t), GFP_KERNEL);
  1743. if(id_ldrive == NULL)
  1744. {
  1745. printk( KERN_ERR "cpqarray:  out of memory.n");
  1746. return;
  1747. }
  1749. id_ctlr_buf = (id_ctlr_t *)kmalloc(sizeof(id_ctlr_t), GFP_KERNEL);
  1750. if(id_ctlr_buf == NULL)
  1751. {
  1752. kfree(id_ldrive);
  1753. printk( KERN_ERR "cpqarray:  out of memory.n");
  1754. return;
  1755. }
  1757. id_lstatus_buf = (sense_log_drv_stat_t *)kmalloc(sizeof(sense_log_drv_stat_t), GFP_KERNEL);
  1758. if(id_lstatus_buf == NULL)
  1759. {
  1760. kfree(id_ctlr_buf);
  1761. kfree(id_ldrive);
  1762. printk( KERN_ERR "cpqarray:  out of memory.n");
  1763. return;
  1764. }
  1766. sense_config_buf = (config_t *)kmalloc(sizeof(config_t), GFP_KERNEL);
  1767. if(sense_config_buf == NULL)
  1768. {
  1769. kfree(id_lstatus_buf);
  1770. kfree(id_ctlr_buf);
  1771. kfree(id_ldrive);
  1772. printk( KERN_ERR "cpqarray:  out of memory.n");
  1773. return;
  1774. }
  1776. memset(id_ldrive, 0, sizeof(id_log_drv_t));
  1777. memset(id_ctlr_buf, 0, sizeof(id_ctlr_t));
  1778. memset(id_lstatus_buf, 0, sizeof(sense_log_drv_stat_t));
  1779. memset(sense_config_buf, 0, sizeof(config_t));
  1781. info_p->phys_drives = 0;
  1782. info_p->log_drv_map = 0;
  1783. info_p->drv_assign_map = 0;
  1784. info_p->drv_spare_map = 0;
  1785. info_p->mp_failed_drv_map = 0; /* only initialized here */
  1786. /* Get controllers info for this logical drive */
  1787. ret_code = sendcmd(ID_CTLR, ctlr, id_ctlr_buf, 0, 0, 0, 0);
  1788. if (ret_code == IO_ERROR) {
  1789. /*
  1790.  * If can't get controller info, set the logical drive map to 0,
  1791.  * so the idastubopen will fail on all logical drives
  1792.  * on the controller.
  1793.  */
  1794.  /* Free all the buffers and return */ 
  1795. printk(KERN_ERR "cpqarray: error sending ID controllern");
  1796. kfree(sense_config_buf);
  1797.                 kfree(id_lstatus_buf);
  1798.                 kfree(id_ctlr_buf);
  1799.                 kfree(id_ldrive);
  1800.                 return;
  1801.         }
  1803. info_p->log_drives = id_ctlr_buf->nr_drvs;;
  1804. for(i=0;i<4;i++)
  1805. info_p->firm_rev[i] = id_ctlr_buf->firm_rev[i];
  1806. info_p->ctlr_sig = id_ctlr_buf->cfg_sig;
  1808. printk(" (%s)n", info_p->product_name);
  1809. /*
  1810.  * Initialize logical drive map to zero
  1811.  */
  1812. log_index = 0;
  1813. /*
  1814.  * Get drive geometry for all logical drives
  1815.  */
  1816. if (id_ctlr_buf->nr_drvs > 16)
  1817. printk(KERN_WARNING "cpqarray ida%d:  This driver supports "
  1818. "16 logical drives per controller.n.  "
  1819. " Additional drives will not be "
  1820. "detectedn", ctlr);
  1822. for (log_unit = 0;
  1823.      (log_index < id_ctlr_buf->nr_drvs)
  1824.      && (log_unit < NWD);
  1825.      log_unit++) {
  1827. size = sizeof(sense_log_drv_stat_t);
  1829. /*
  1830.    Send "Identify logical drive status" cmd
  1831.  */
  1832. ret_code = sendcmd(SENSE_LOG_DRV_STAT,
  1833.      ctlr, id_lstatus_buf, size, 0, 0, log_unit);
  1834. if (ret_code == IO_ERROR) {
  1835. /*
  1836.    If can't get logical drive status, set
  1837.    the logical drive map to 0, so the
  1838.    idastubopen will fail for all logical drives
  1839.    on the controller. 
  1840.  */
  1841. info_p->log_drv_map = 0;
  1842. printk( KERN_WARNING
  1843.      "cpqarray ida%d: idaGetGeometry - Controller"
  1844. " failed to report status of logical drive %dn"
  1845.  "Access to this controller has been disabledn",
  1846. ctlr, log_unit);
  1847. /* Free all the buffers and return */
  1848.                  kfree(sense_config_buf);
  1849.                  kfree(id_lstatus_buf);
  1850.                  kfree(id_ctlr_buf);
  1851.                  kfree(id_ldrive);
  1852.                  return;
  1853. }
  1854. /*
  1855.    Make sure the logical drive is configured
  1856.  */
  1857. if (id_lstatus_buf->status != LOG_NOT_CONF) {
  1858. ret_code = sendcmd(ID_LOG_DRV, ctlr, id_ldrive,
  1859.        sizeof(id_log_drv_t), 0, 0, log_unit);
  1860. /*
  1861.    If error, the bit for this
  1862.    logical drive won't be set and
  1863.    idastubopen will return error. 
  1864.  */
  1865. if (ret_code != IO_ERROR) {
  1866. drv = &info_p->drv[log_unit];
  1867. drv->blk_size = id_ldrive->blk_size;
  1868. drv->nr_blks = id_ldrive->nr_blks;
  1869. drv->cylinders = id_ldrive->drv.cyl;
  1870. drv->heads = id_ldrive->drv.heads;
  1871. drv->sectors = id_ldrive->drv.sect_per_track;
  1872. info_p->log_drv_map |= (1 << log_unit);
  1874. printk(KERN_INFO "cpqarray ida/c%dd%d: blksz=%d nr_blks=%dn",
  1875. ctlr, log_unit, drv->blk_size, drv->nr_blks);
  1876. ret_code = sendcmd(SENSE_CONFIG,
  1877.   ctlr, sense_config_buf,
  1878.  sizeof(config_t), 0, 0, log_unit);
  1879. if (ret_code == IO_ERROR) {
  1880. info_p->log_drv_map = 0;
  1881. /* Free all the buffers and return */
  1882.                  printk(KERN_ERR "cpqarray: error sending sense confign");
  1883.                  kfree(sense_config_buf);
  1884.                  kfree(id_lstatus_buf);
  1885.                  kfree(id_ctlr_buf);
  1886.                  kfree(id_ldrive);
  1887.                  return;
  1889. }
  1890. if (!de_arr[ctlr][log_unit]) {
  1891. char txt[16];
  1893. sprintf(txt, "ida/c%dd%d", ctlr,
  1894. log_unit);
  1895. de_arr[ctlr][log_unit] =
  1896. devfs_mk_dir(NULL, txt, NULL);
  1897. }
  1898. info_p->phys_drives =
  1899.     sense_config_buf->ctlr_phys_drv;
  1900. info_p->drv_assign_map
  1901.     |= sense_config_buf->drv_asgn_map;
  1902. info_p->drv_assign_map
  1903.     |= sense_config_buf->spare_asgn_map;
  1904. info_p->drv_spare_map
  1905.     |= sense_config_buf->spare_asgn_map;
  1906. } /* end of if no error on id_ldrive */
  1907. log_index = log_index + 1;
  1908. } /* end of if logical drive configured */
  1909. } /* end of for log_unit */
  1910. kfree(sense_config_buf);
  1911.    kfree(id_ldrive);
  1912.    kfree(id_lstatus_buf);
  1913. kfree(id_ctlr_buf);
  1914. return;
  1916. }