i2o_block.c
上传用户:lgb322
上传日期:2013-02-24
资源大小:30529k
文件大小:47k
源码类别:

嵌入式Linux

开发平台:

Unix_Linux

  1. /*
  2.  * I2O Random Block Storage Class OSM
  3.  *
  4.  * (C) Copyright 1999 Red Hat Software
  5.  *
  6.  * Written by Alan Cox, Building Number Three Ltd
  7.  *
  8.  * This program is free software; you can redistribute it and/or
  9.  * modify it under the terms of the GNU General Public License
  10.  * as published by the Free Software Foundation; either version
  11.  * 2 of the License, or (at your option) any later version.
  12.  *
  13.  * This is a beta test release. Most of the good code was taken
  14.  * from the nbd driver by Pavel Machek, who in turn took some of it
  15.  * from loop.c. Isn't free software great for reusability 8)
  16.  *
  17.  * Fixes/additions:
  18.  * Steve Ralston:
  19.  * Multiple device handling error fixes,
  20.  * Added a queue depth.
  21.  * Alan Cox:
  22.  * FC920 has an rmw bug. Dont or in the end marker.
  23.  * Removed queue walk, fixed for 64bitness.
  24.  * Deepak Saxena:
  25.  * Independent queues per IOP
  26.  * Support for dynamic device creation/deletion
  27.  * Code cleanup
  28.  *     Support for larger I/Os through merge* functions 
  29.  *        (taken from DAC960 driver)
  30.  * Boji T Kannanthanam:
  31.  * Set the I2O Block devices to be detected in increasing 
  32.  * order of TIDs during boot.
  33.  * Search and set the I2O block device that we boot off from  as
  34.  * the first device to be claimed (as /dev/i2o/hda)
  35.  * Properly attach/detach I2O gendisk structure from the system
  36.  * gendisk list. The I2O block devices now appear in 
  37.  *  /proc/partitions.
  38.  *
  39.  * To do:
  40.  * Serial number scanning to find duplicates for FC multipathing
  41.  */
  42. #include <linux/major.h>
  43. #include <linux/module.h>
  44. #include <linux/sched.h>
  45. #include <linux/fs.h>
  46. #include <linux/stat.h>
  47. #include <linux/pci.h>
  48. #include <linux/errno.h>
  49. #include <linux/file.h>
  50. #include <linux/ioctl.h>
  51. #include <linux/i2o.h>
  52. #include <linux/blkdev.h>
  53. #include <linux/blkpg.h>
  54. #include <linux/slab.h>
  55. #include <linux/hdreg.h>
  56. #include <linux/spinlock.h>
  57. #include <linux/notifier.h>
  58. #include <linux/reboot.h>
  59. #include <asm/uaccess.h>
  60. #include <asm/semaphore.h>
  61. #include <linux/completion.h>
  62. #include <asm/io.h>
  63. #include <asm/atomic.h>
  64. #include <linux/smp_lock.h>
  65. #include <linux/wait.h>
  66. #define MAJOR_NR I2O_MAJOR
  67. #include <linux/blk.h>
  68. #define MAX_I2OB 16
  69. #define MAX_I2OB_DEPTH 128
  70. #define MAX_I2OB_RETRIES 4
  71. //#define DRIVERDEBUG
  72. #ifdef DRIVERDEBUG
  73. #define DEBUG( s ) printk( s )
  74. #else
  75. #define DEBUG( s )
  76. #endif
  77. /*
  78.  * Events that this OSM is interested in
  79.  */
  80. #define I2OB_EVENT_MASK (I2O_EVT_IND_BSA_VOLUME_LOAD |
  81.  I2O_EVT_IND_BSA_VOLUME_UNLOAD | 
  82.  I2O_EVT_IND_BSA_VOLUME_UNLOAD_REQ | 
  83.  I2O_EVT_IND_BSA_CAPACITY_CHANGE | 
  84.  I2O_EVT_IND_BSA_SCSI_SMART )
  85. /*
  86.  * I2O Block Error Codes - should be in a header file really...
  87.  */
  88. #define I2O_BSA_DSC_SUCCESS             0x0000
  89. #define I2O_BSA_DSC_MEDIA_ERROR         0x0001
  90. #define I2O_BSA_DSC_ACCESS_ERROR        0x0002
  91. #define I2O_BSA_DSC_DEVICE_FAILURE      0x0003
  92. #define I2O_BSA_DSC_DEVICE_NOT_READY    0x0004
  93. #define I2O_BSA_DSC_MEDIA_NOT_PRESENT   0x0005
  94. #define I2O_BSA_DSC_MEDIA_LOCKED        0x0006
  95. #define I2O_BSA_DSC_MEDIA_FAILURE       0x0007
  96. #define I2O_BSA_DSC_PROTOCOL_FAILURE    0x0008
  97. #define I2O_BSA_DSC_BUS_FAILURE         0x0009
  98. #define I2O_BSA_DSC_ACCESS_VIOLATION    0x000A
  99. #define I2O_BSA_DSC_WRITE_PROTECTED     0x000B
  100. #define I2O_BSA_DSC_DEVICE_RESET        0x000C
  101. #define I2O_BSA_DSC_VOLUME_CHANGED      0x000D
  102. #define I2O_BSA_DSC_TIMEOUT             0x000E
  103. /*
  104.  * Some of these can be made smaller later
  105.  */
  106. static int i2ob_blksizes[MAX_I2OB<<4];
  107. static int i2ob_hardsizes[MAX_I2OB<<4];
  108. static int i2ob_sizes[MAX_I2OB<<4];
  109. static int i2ob_media_change_flag[MAX_I2OB];
  110. static u32 i2ob_max_sectors[MAX_I2OB<<4];
  111. static int i2ob_context;
  112. /*
  113.  * I2O Block device descriptor 
  114.  */
  115. struct i2ob_device
  116. {
  117. struct i2o_controller *controller;
  118. struct i2o_device *i2odev;
  119. int unit;
  120. int tid;
  121. int flags;
  122. int refcnt;
  123. struct request *head, *tail;
  124. request_queue_t *req_queue;
  125. int max_segments;
  126. int done_flag;
  127. int constipated;
  128. int depth;
  129. };
  130. /*
  131.  * FIXME:
  132.  * We should cache align these to avoid ping-ponging lines on SMP
  133.  * boxes under heavy I/O load...
  134.  */
  135. struct i2ob_request
  136. {
  137. struct i2ob_request *next;
  138. struct request *req;
  139. int num;
  140. };
  141. /*
  142.  * Per IOP requst queue information
  143.  *
  144.  * We have a separate requeust_queue_t per IOP so that a heavilly
  145.  * loaded I2O block device on an IOP does not starve block devices
  146.  * across all I2O controllers.
  147.  * 
  148.  */
  149. struct i2ob_iop_queue
  150. {
  151. atomic_t queue_depth;
  152. struct i2ob_request request_queue[MAX_I2OB_DEPTH];
  153. struct i2ob_request *i2ob_qhead;
  154. request_queue_t req_queue;
  155. };
  156. static struct i2ob_iop_queue *i2ob_queues[MAX_I2O_CONTROLLERS];
  157. static struct i2ob_request *i2ob_backlog[MAX_I2O_CONTROLLERS];
  158. static struct i2ob_request *i2ob_backlog_tail[MAX_I2O_CONTROLLERS];
  159. /*
  160.  * Each I2O disk is one of these.
  161.  */
  162. static struct i2ob_device i2ob_dev[MAX_I2OB<<4];
  163. static int i2ob_dev_count = 0;
  164. static struct hd_struct i2ob[MAX_I2OB<<4];
  165. static struct gendisk i2ob_gendisk; /* Declared later */
  166. /*
  167.  * Mutex and spin lock for event handling synchronization
  168.  * evt_msg contains the last event.
  169.  */
  170. static DECLARE_MUTEX_LOCKED(i2ob_evt_sem);
  171. static DECLARE_COMPLETION(i2ob_thread_dead);
  172. static spinlock_t i2ob_evt_lock = SPIN_LOCK_UNLOCKED;
  173. static u32 evt_msg[MSG_FRAME_SIZE>>2];
  174. static struct timer_list i2ob_timer;
  175. static int i2ob_timer_started = 0;
  176. static void i2o_block_reply(struct i2o_handler *, struct i2o_controller *,
  177.  struct i2o_message *);
  178. static void i2ob_new_device(struct i2o_controller *, struct i2o_device *);
  179. static void i2ob_del_device(struct i2o_controller *, struct i2o_device *);
  180. static void i2ob_reboot_event(void);
  181. static int i2ob_install_device(struct i2o_controller *, struct i2o_device *, int);
  182. static void i2ob_end_request(struct request *);
  183. static void i2ob_request(request_queue_t *);
  184. static int i2ob_backlog_request(struct i2o_controller *, struct i2ob_device *);
  185. static int i2ob_init_iop(unsigned int);
  186. static request_queue_t* i2ob_get_queue(kdev_t);
  187. static int i2ob_query_device(struct i2ob_device *, int, int, void*, int);
  188. static int do_i2ob_revalidate(kdev_t, int);
  189. static int i2ob_evt(void *);
  190. static int evt_pid = 0;
  191. static int evt_running = 0;
  192. static int scan_unit = 0;
  193. /*
  194.  * I2O OSM registration structure...keeps getting bigger and bigger :)
  195.  */
  196. static struct i2o_handler i2o_block_handler =
  197. {
  198. i2o_block_reply,
  199. i2ob_new_device,
  200. i2ob_del_device,
  201. i2ob_reboot_event,
  202. "I2O Block OSM",
  203. 0,
  204. I2O_CLASS_RANDOM_BLOCK_STORAGE
  205. };
  206. /*
  207.  * Get a message
  208.  */
  209. static u32 i2ob_get(struct i2ob_device *dev)
  210. {
  211. struct i2o_controller *c=dev->controller;
  212.     return I2O_POST_READ32(c);
  213. }
  214.  
  215. /*
  216.  * Turn a Linux block request into an I2O block read/write.
  217.  */
  218. static int i2ob_send(u32 m, struct i2ob_device *dev, struct i2ob_request *ireq, u32 base, int unit)
  219. {
  220. struct i2o_controller *c = dev->controller;
  221. int tid = dev->tid;
  222. unsigned long msg;
  223. unsigned long mptr;
  224. u64 offset;
  225. struct request *req = ireq->req;
  226. struct buffer_head *bh = req->bh;
  227. int count = req->nr_sectors<<9;
  228. char *last = NULL;
  229. unsigned short size = 0;
  230. // printk(KERN_INFO "i2ob_send calledn");
  231. /* Map the message to a virtual address */
  232. msg = c->mem_offset + m;
  233. /*
  234.  * Build the message based on the request.
  235.  */
  236. __raw_writel(i2ob_context|(unit<<8), msg+8);
  237. __raw_writel(ireq->num, msg+12);
  238. __raw_writel(req->nr_sectors << 9, msg+20);
  239. /* 
  240.  * Mask out partitions from now on
  241.  */
  242. unit &= 0xF0;
  243. /* This can be optimised later - just want to be sure its right for
  244.    starters */
  245. offset = ((u64)(req->sector+base)) << 9;
  246. __raw_writel( offset & 0xFFFFFFFF, msg+24);
  247. __raw_writel(offset>>32, msg+28);
  248. mptr=msg+32;
  249. if(req->cmd == READ)
  250. {
  251. DEBUG("READn");
  252. __raw_writel(I2O_CMD_BLOCK_READ<<24|HOST_TID<<12|tid, msg+4);
  253. while(bh!=NULL)
  254. {
  255. if(bh->b_data == last) {
  256. size += bh->b_size;
  257. last += bh->b_size;
  258. if(bh->b_reqnext)
  259. __raw_writel(0x14000000|(size), mptr-8);
  260. else
  261. __raw_writel(0xD4000000|(size), mptr-8);
  262. }
  263. else
  264. {
  265. if(bh->b_reqnext)
  266. __raw_writel(0x10000000|(bh->b_size), mptr);
  267. else
  268. __raw_writel(0xD0000000|(bh->b_size), mptr);
  269. __raw_writel(virt_to_bus(bh->b_data), mptr+4);
  270. mptr += 8;
  271. size = bh->b_size;
  272. last = bh->b_data + size;
  273. }
  274. count -= bh->b_size;
  275. bh = bh->b_reqnext;
  276. }
  277. /*
  278.  * Heuristic for now since the block layer doesnt give
  279.  * us enough info. If its a big write assume sequential
  280.  * readahead on controller. If its small then don't read
  281.  * ahead but do use the controller cache.
  282.  */
  283. if(size >= 8192)
  284. __raw_writel((8<<24)|(1<<16)|8, msg+16);
  285. else
  286. __raw_writel((8<<24)|(1<<16)|4, msg+16);
  287. }
  288. else if(req->cmd == WRITE)
  289. {
  290. DEBUG("WRITEn");
  291. __raw_writel(I2O_CMD_BLOCK_WRITE<<24|HOST_TID<<12|tid, msg+4);
  292. while(bh!=NULL)
  293. {
  294. if(bh->b_data == last) {
  295. size += bh->b_size;
  296. last += bh->b_size;
  297. if(bh->b_reqnext)
  298. __raw_writel(0x14000000|(size), mptr-8);
  299. else
  300. __raw_writel(0xD4000000|(size), mptr-8);
  301. }
  302. else
  303. {
  304. if(bh->b_reqnext)
  305. __raw_writel(0x14000000|(bh->b_size), mptr);
  306. else
  307. __raw_writel(0xD4000000|(bh->b_size), mptr);
  308. __raw_writel(virt_to_bus(bh->b_data), mptr+4);
  309. mptr += 8;
  310. size = bh->b_size;
  311. last = bh->b_data + size;
  312. }
  313. count -= bh->b_size;
  314. bh = bh->b_reqnext;
  315. }
  316. if(c->battery)
  317. {
  318. if(size>16384)
  319. __raw_writel(4, msg+16);
  320. else
  321. /* 
  322.  * Allow replies to come back once data is cached in the controller
  323.  * This allows us to handle writes quickly thus giving more of the
  324.  * queue to reads.
  325.  */
  326. __raw_writel(16, msg+16);
  327. }
  328. else
  329. {
  330. /* Large write, don't cache */
  331. if(size>8192)
  332. __raw_writel(4, msg+16);
  333. else
  334. /* write through */
  335. __raw_writel(8, msg+16);
  336. }
  337. }
  338. __raw_writel(I2O_MESSAGE_SIZE(mptr-msg)>>2 | SGL_OFFSET_8, msg);
  339. if(count != 0)
  340. {
  341. printk(KERN_ERR "Request count botched by %d.n", count);
  342. }
  343. i2o_post_message(c,m);
  344. atomic_inc(&i2ob_queues[c->unit]->queue_depth);
  345. return 0;
  346. }
  347. /*
  348.  * Remove a request from the _locked_ request list. We update both the
  349.  * list chain and if this is the last item the tail pointer. Caller
  350.  * must hold the lock.
  351.  */
  352.  
  353. static inline void i2ob_unhook_request(struct i2ob_request *ireq, 
  354. unsigned int iop)
  355. {
  356. ireq->next = i2ob_queues[iop]->i2ob_qhead;
  357. i2ob_queues[iop]->i2ob_qhead = ireq;
  358. }
  359. /*
  360.  * Request completion handler
  361.  */
  362.  
  363. static inline void i2ob_end_request(struct request *req)
  364. {
  365. /*
  366.  * Loop until all of the buffers that are linked
  367.  * to this request have been marked updated and
  368.  * unlocked.
  369.  */
  370. while (end_that_request_first( req, !req->errors, "i2o block" ));
  371. /*
  372.  * It is now ok to complete the request.
  373.  */
  374. end_that_request_last( req );
  375. DEBUG("IO COMPLETEDn");
  376. }
  377. /*
  378.  * Request merging functions
  379.  */
  380. static inline int i2ob_new_segment(request_queue_t *q, struct request *req,
  381.   int __max_segments)
  382. {
  383. int max_segments = i2ob_dev[MINOR(req->rq_dev)].max_segments;
  384. if (__max_segments < max_segments)
  385. max_segments = __max_segments;
  386. if (req->nr_segments < max_segments) {
  387. req->nr_segments++;
  388. return 1;
  389. }
  390. return 0;
  391. }
  392. static int i2ob_back_merge(request_queue_t *q, struct request *req, 
  393.      struct buffer_head *bh, int __max_segments)
  394. {
  395. if (req->bhtail->b_data + req->bhtail->b_size == bh->b_data)
  396. return 1;
  397. return i2ob_new_segment(q, req, __max_segments);
  398. }
  399. static int i2ob_front_merge(request_queue_t *q, struct request *req, 
  400.       struct buffer_head *bh, int __max_segments)
  401. {
  402. if (bh->b_data + bh->b_size == req->bh->b_data)
  403. return 1;
  404. return i2ob_new_segment(q, req, __max_segments);
  405. }
  406. static int i2ob_merge_requests(request_queue_t *q,
  407. struct request *req,
  408. struct request *next,
  409. int __max_segments)
  410. {
  411. int max_segments = i2ob_dev[MINOR(req->rq_dev)].max_segments;
  412. int total_segments = req->nr_segments + next->nr_segments;
  413. if (__max_segments < max_segments)
  414. max_segments = __max_segments;
  415. if (req->bhtail->b_data + req->bhtail->b_size == next->bh->b_data)
  416. total_segments--;
  417.     
  418. if (total_segments > max_segments)
  419. return 0;
  420. req->nr_segments = total_segments;
  421. return 1;
  422. }
  423. static int i2ob_flush(struct i2o_controller *c, struct i2ob_device *d, int unit)
  424. {
  425. unsigned long msg;
  426. u32 m = i2ob_get(d);
  427. if(m == 0xFFFFFFFF)
  428. return -1;
  429. msg = c->mem_offset + m;
  430. /*
  431.  * Ask the controller to write the cache back. This sorts out
  432.  * the supertrak firmware flaw and also does roughly the right
  433.  * thing for other cases too.
  434.  */
  435.  
  436. __raw_writel(FIVE_WORD_MSG_SIZE|SGL_OFFSET_0, msg);
  437. __raw_writel(I2O_CMD_BLOCK_CFLUSH<<24|HOST_TID<<12|d->tid, msg+4);
  438. __raw_writel(i2ob_context|(unit<<8), msg+8);
  439. __raw_writel(0, msg+12);
  440. __raw_writel(60<<16, msg+16);
  441. DEBUG("FLUSH");
  442. i2o_post_message(c,m);
  443. return 0;
  444. }
  445. /*
  446.  * OSM reply handler. This gets all the message replies
  447.  */
  448. static void i2o_block_reply(struct i2o_handler *h, struct i2o_controller *c, struct i2o_message *msg)
  449. {
  450. unsigned long flags;
  451. struct i2ob_request *ireq = NULL;
  452. u8 st;
  453. u32 *m = (u32 *)msg;
  454. u8 unit = (m[2]>>8)&0xF0; /* low 4 bits are partition */
  455. struct i2ob_device *dev = &i2ob_dev[(unit&0xF0)];
  456. /*
  457.  * Pull the lock over ready
  458.  */
  459.  
  460. spin_lock_prefetch(&io_request_lock);
  461. /*
  462.  * FAILed message
  463.  */
  464. if(m[0] & (1<<13))
  465. {
  466. DEBUG("FAIL");
  467. /*
  468.  * FAILed message from controller
  469.  * We increment the error count and abort it
  470.  *
  471.  * In theory this will never happen.  The I2O block class
  472.  * speficiation states that block devices never return
  473.  * FAILs but instead use the REQ status field...but
  474.  * better be on the safe side since no one really follows
  475.  * the spec to the book :)
  476.  */
  477. ireq=&i2ob_queues[c->unit]->request_queue[m[3]];
  478. ireq->req->errors++;
  479. spin_lock_irqsave(&io_request_lock, flags);
  480. i2ob_unhook_request(ireq, c->unit);
  481. i2ob_end_request(ireq->req);
  482. spin_unlock_irqrestore(&io_request_lock, flags);
  483. /* Now flush the message by making it a NOP */
  484. m[0]&=0x00FFFFFF;
  485. m[0]|=(I2O_CMD_UTIL_NOP)<<24;
  486. i2o_post_message(c,virt_to_bus(m));
  487. return;
  488. }
  489. if(msg->function == I2O_CMD_UTIL_EVT_REGISTER)
  490. {
  491. spin_lock(&i2ob_evt_lock);
  492. memcpy(evt_msg, msg, (m[0]>>16)<<2);
  493. spin_unlock(&i2ob_evt_lock);
  494. up(&i2ob_evt_sem);
  495. return;
  496. }
  497. if(msg->function == I2O_CMD_BLOCK_CFLUSH)
  498. {
  499. spin_lock_irqsave(&io_request_lock, flags);
  500. dev->constipated=0;
  501. DEBUG("unconstipatedn");
  502. if(i2ob_backlog_request(c, dev)==0)
  503. i2ob_request(dev->req_queue);
  504. spin_unlock_irqrestore(&io_request_lock, flags);
  505. return;
  506. }
  507. if(!dev->i2odev)
  508. {
  509. /*
  510.  * This is HACK, but Intel Integrated RAID allows user
  511.  * to delete a volume that is claimed, locked, and in use 
  512.  * by the OS. We have to check for a reply from a
  513.  * non-existent device and flag it as an error or the system 
  514.  * goes kaput...
  515.  */
  516. ireq=&i2ob_queues[c->unit]->request_queue[m[3]];
  517. ireq->req->errors++;
  518. printk(KERN_WARNING "I2O Block: Data transfer to deleted device!n");
  519. spin_lock_irqsave(&io_request_lock, flags);
  520. i2ob_unhook_request(ireq, c->unit);
  521. i2ob_end_request(ireq->req);
  522. spin_unlock_irqrestore(&io_request_lock, flags);
  523. return;
  524. }
  525. /*
  526.  * Lets see what is cooking. We stuffed the
  527.  * request in the context.
  528.  */
  529.  
  530. ireq=&i2ob_queues[c->unit]->request_queue[m[3]];
  531. st=m[4]>>24;
  532. if(st!=0)
  533. {
  534. int err;
  535. char *bsa_errors[] = 
  536. "Success", 
  537. "Media Error", 
  538. "Failure communicating to device",
  539. "Device Failure",
  540. "Device is not ready",
  541. "Media not present",
  542. "Media is locked by another user",
  543. "Media has failed",
  544. "Failure communicating to device",
  545. "Device bus failure",
  546. "Device is locked by another user",
  547. "Device is write protected",
  548. "Device has reset",
  549. "Volume has changed, waiting for acknowledgement"
  550. };
  551. err = m[4]&0xFFFF;
  552. /*
  553.  * Device not ready means two things. One is that the
  554.  * the thing went offline (but not a removal media)
  555.  *
  556.  * The second is that you have a SuperTrak 100 and the
  557.  * firmware got constipated. Unlike standard i2o card
  558.  * setups the supertrak returns an error rather than
  559.  * blocking for the timeout in these cases.
  560.  */
  561.  
  562. spin_lock_irqsave(&io_request_lock, flags);
  563. if(err==4)
  564. {
  565. /*
  566.  * Time to uncork stuff
  567.  */
  568. if(!dev->constipated)
  569. {
  570. dev->constipated = 1;
  571. DEBUG(("constipatedn"));
  572. /* Now pull the chain */
  573. if(i2ob_flush(c, dev, unit)<0)
  574. {
  575. DEBUG(("i2ob: Unable to queue flush. Retrying I/O immediately.n"));
  576. dev->constipated=0;
  577. }
  578. DEBUG(("flushingn"));
  579. }
  580. /*
  581.  * Recycle the request
  582.  */
  583.  
  584. // i2ob_unhook_request(ireq, c->unit);
  585. /*
  586.  * Place it on the recycle queue
  587.  */
  588.  
  589. ireq->next = NULL;
  590. if(i2ob_backlog_tail[c->unit]!=NULL)
  591. i2ob_backlog_tail[c->unit]->next = ireq;
  592. else
  593. i2ob_backlog[c->unit] = ireq;
  594. i2ob_backlog_tail[c->unit] = ireq;
  595. atomic_dec(&i2ob_queues[c->unit]->queue_depth);
  596. /*
  597.  * If the constipator flush failed we want to
  598.  * poke the queue again. 
  599.  */
  600.  
  601. i2ob_request(dev->req_queue);
  602. spin_unlock_irqrestore(&io_request_lock, flags);
  603. /*
  604.  * and out
  605.  */
  606.  
  607. return;
  608. }
  609. spin_unlock_irqrestore(&io_request_lock, flags);
  610. printk(KERN_ERR "n/dev/%s error: %s", dev->i2odev->dev_name, 
  611. bsa_errors[m[4]&0XFFFF]);
  612. if(m[4]&0x00FF0000)
  613. printk(" - DDM attempted %d retries", (m[4]>>16)&0x00FF );
  614. printk(".n");
  615. ireq->req->errors++;
  616. }
  617. else
  618. ireq->req->errors = 0;
  619. /*
  620.  * Dequeue the request. We use irqsave locks as one day we
  621.  * may be running polled controllers from a BH...
  622.  */
  623. spin_lock_irqsave(&io_request_lock, flags);
  624. i2ob_unhook_request(ireq, c->unit);
  625. i2ob_end_request(ireq->req);
  626. atomic_dec(&i2ob_queues[c->unit]->queue_depth);
  627. /*
  628.  * We may be able to do more I/O
  629.  */
  630. if(i2ob_backlog_request(c, dev)==0)
  631. i2ob_request(dev->req_queue);
  632. spin_unlock_irqrestore(&io_request_lock, flags);
  633. }
  634. /* 
  635.  * Event handler.  Needs to be a separate thread b/c we may have
  636.  * to do things like scan a partition table, or query parameters
  637.  * which cannot be done from an interrupt or from a bottom half.
  638.  */
  639. static int i2ob_evt(void *dummy)
  640. {
  641. unsigned int evt;
  642. unsigned long flags;
  643. int unit;
  644. int i;
  645. //The only event that has data is the SCSI_SMART event.
  646. struct i2o_reply {
  647. u32 header[4];
  648. u32 evt_indicator;
  649. u8 ASC;
  650. u8 ASCQ;
  651. u8 data[16];
  652. } *evt_local;
  653. lock_kernel();
  654. daemonize();
  655. unlock_kernel();
  656. strcpy(current->comm, "i2oblock");
  657. evt_running = 1;
  658. while(1)
  659. {
  660. if(down_interruptible(&i2ob_evt_sem))
  661. {
  662. evt_running = 0;
  663. printk("exiting...");
  664. break;
  665. }
  666. /*
  667.  * Keep another CPU/interrupt from overwriting the 
  668.  * message while we're reading it
  669.  *
  670.  * We stuffed the unit in the TxContext and grab the event mask
  671.  * None of the BSA we care about events have EventData
  672.  */
  673. spin_lock_irqsave(&i2ob_evt_lock, flags);
  674. evt_local = (struct i2o_reply *)evt_msg;
  675. spin_unlock_irqrestore(&i2ob_evt_lock, flags);
  676. unit = evt_local->header[3];
  677. evt = evt_local->evt_indicator;
  678. switch(evt)
  679. {
  680. /*
  681.  * New volume loaded on same TID, so we just re-install.
  682.  * The TID/controller don't change as it is the same
  683.  * I2O device.  It's just new media that we have to
  684.  * rescan.
  685.  */
  686. case I2O_EVT_IND_BSA_VOLUME_LOAD:
  687. {
  688. i2ob_install_device(i2ob_dev[unit].i2odev->controller, 
  689. i2ob_dev[unit].i2odev, unit);
  690. break;
  691. }
  692. /*
  693.  * No media, so set all parameters to 0 and set the media
  694.  * change flag. The I2O device is still valid, just doesn't
  695.  * have media, so we don't want to clear the controller or
  696.  * device pointer.
  697.  */
  698. case I2O_EVT_IND_BSA_VOLUME_UNLOAD:
  699. {
  700. for(i = unit; i <= unit+15; i++)
  701. {
  702. i2ob_sizes[i] = 0;
  703. i2ob_hardsizes[i] = 0;
  704. i2ob_max_sectors[i] = 0;
  705. i2ob[i].nr_sects = 0;
  706. i2ob_gendisk.part[i].nr_sects = 0;
  707. }
  708. i2ob_media_change_flag[unit] = 1;
  709. break;
  710. }
  711. case I2O_EVT_IND_BSA_VOLUME_UNLOAD_REQ:
  712. printk(KERN_WARNING "%s: Attempt to eject locked median", 
  713. i2ob_dev[unit].i2odev->dev_name);
  714. break;
  715. /*
  716.  * The capacity has changed and we are going to be
  717.  * updating the max_sectors and other information 
  718.  * about this disk.  We try a revalidate first. If
  719.  * the block device is in use, we don't want to
  720.  * do that as there may be I/Os bound for the disk
  721.  * at the moment.  In that case we read the size 
  722.  * from the device and update the information ourselves
  723.  * and the user can later force a partition table
  724.  * update through an ioctl.
  725.  */
  726. case I2O_EVT_IND_BSA_CAPACITY_CHANGE:
  727. {
  728. u64 size;
  729. if(do_i2ob_revalidate(MKDEV(MAJOR_NR, unit),0) != -EBUSY)
  730. continue;
  731.    if(i2ob_query_device(&i2ob_dev[unit], 0x0004, 0, &size, 8) !=0 )
  732. i2ob_query_device(&i2ob_dev[unit], 0x0000, 4, &size, 8);
  733. spin_lock_irqsave(&io_request_lock, flags);
  734. i2ob_sizes[unit] = (int)(size>>10);
  735. i2ob_gendisk.part[unit].nr_sects = size>>9;
  736. i2ob[unit].nr_sects = (int)(size>>9);
  737. spin_unlock_irqrestore(&io_request_lock, flags);
  738. break;
  739. }
  740. /* 
  741.  * We got a SCSI SMART event, we just log the relevant
  742.  * information and let the user decide what they want
  743.  * to do with the information.
  744.  */
  745. case I2O_EVT_IND_BSA_SCSI_SMART:
  746. {
  747. char buf[16];
  748. printk(KERN_INFO "I2O Block: %s received a SCSI SMART Eventn",i2ob_dev[unit].i2odev->dev_name);
  749. evt_local->data[16]='';
  750. sprintf(buf,"%s",&evt_local->data[0]);
  751. printk(KERN_INFO "      Disk Serial#:%sn",buf);
  752. printk(KERN_INFO "      ASC 0x%02x n",evt_local->ASC);
  753. printk(KERN_INFO "      ASCQ 0x%02x n",evt_local->ASCQ);
  754. break;
  755. }
  756. /*
  757.  * Non event
  758.  */
  759.  
  760. case 0:
  761. break;
  762. /*
  763.  * An event we didn't ask for.  Call the card manufacturer
  764.  * and tell them to fix their firmware :)
  765.  */
  766. default:
  767. printk(KERN_INFO "%s: Received event 0x%X we didn't register forn"
  768. KERN_INFO "   Blame the I2O card manufacturer 8)n", 
  769. i2ob_dev[unit].i2odev->dev_name, evt);
  770. break;
  771. }
  772. };
  773. complete_and_exit(&i2ob_thread_dead,0);
  774. return 0;
  775. }
  776. /*
  777.  * The timer handler will attempt to restart requests 
  778.  * that are queued to the driver.  This handler
  779.  * currently only gets called if the controller
  780.  * had no more room in its inbound fifo.  
  781.  */
  782. static void i2ob_timer_handler(unsigned long q)
  783. {
  784. unsigned long flags;
  785. /*
  786.  * We cannot touch the request queue or the timer
  787.          * flag without holding the io_request_lock.
  788.  */
  789. spin_lock_irqsave(&io_request_lock,flags);
  790. /* 
  791.  * Clear the timer started flag so that 
  792.  * the timer can be queued again.
  793.  */
  794. i2ob_timer_started = 0;
  795. /* 
  796.  * Restart any requests.
  797.  */
  798. i2ob_request((request_queue_t*)q);
  799. /* 
  800.  * Free the lock.
  801.  */
  802. spin_unlock_irqrestore(&io_request_lock,flags);
  803. }
  804. static int i2ob_backlog_request(struct i2o_controller *c, struct i2ob_device *dev)
  805. {
  806. u32 m;
  807. struct i2ob_request *ireq;
  808. while((ireq=i2ob_backlog[c->unit])!=NULL)
  809. {
  810. int unit;
  811. if(atomic_read(&i2ob_queues[c->unit]->queue_depth) > dev->depth/4)
  812. break;
  813. m = i2ob_get(dev);
  814. if(m == 0xFFFFFFFF)
  815. break;
  816. i2ob_backlog[c->unit] = ireq->next;
  817. if(i2ob_backlog[c->unit] == NULL)
  818. i2ob_backlog_tail[c->unit] = NULL;
  819. unit = MINOR(ireq->req->rq_dev);
  820. i2ob_send(m, dev, ireq, i2ob[unit].start_sect, unit);
  821. }
  822. if(i2ob_backlog[c->unit])
  823. return 1;
  824. return 0;
  825. }
  826. /*
  827.  * The I2O block driver is listed as one of those that pulls the
  828.  * front entry off the queue before processing it. This is important
  829.  * to remember here. If we drop the io lock then CURRENT will change
  830.  * on us. We must unlink CURRENT in this routine before we return, if
  831.  * we use it.
  832.  */
  833. static void i2ob_request(request_queue_t *q)
  834. {
  835. struct request *req;
  836. struct i2ob_request *ireq;
  837. int unit;
  838. struct i2ob_device *dev;
  839. u32 m;
  840. while (!list_empty(&q->queue_head)) {
  841. /*
  842.  * On an IRQ completion if there is an inactive
  843.  * request on the queue head it means it isnt yet
  844.  * ready to dispatch.
  845.  */
  846. req = blkdev_entry_next_request(&q->queue_head);
  847. if(req->rq_status == RQ_INACTIVE)
  848. return;
  849. unit = MINOR(req->rq_dev);
  850. dev = &i2ob_dev[(unit&0xF0)];
  851. /* 
  852.  * Queue depths probably belong with some kind of 
  853.  * generic IOP commit control. Certainly its not right 
  854.  * its global!  
  855.  */
  856. if(atomic_read(&i2ob_queues[dev->unit]->queue_depth) >= dev->depth)
  857. break;
  858. /*
  859.  * Is the channel constipated ?
  860.  */
  861. if(i2ob_backlog[dev->unit]!=NULL)
  862. break;
  863. /* Get a message */
  864. m = i2ob_get(dev);
  865. if(m==0xFFFFFFFF)
  866. {
  867. /* 
  868.  * See if the timer has already been queued.
  869.  */
  870. if (!i2ob_timer_started)
  871. {
  872. DEBUG((KERN_ERR "i2ob: starting timern"));
  873. /*
  874.  * Set the timer_started flag to insure
  875.  * that the timer is only queued once.
  876.  * Queing it more than once will corrupt
  877.  * the timer queue.
  878.  */
  879. i2ob_timer_started = 1;
  880. /* 
  881.  * Set up the timer to expire in
  882.  * 500ms.
  883.  */
  884. i2ob_timer.expires = jiffies + (HZ >> 1);
  885. i2ob_timer.data = (unsigned int)q;
  886. /*
  887.  * Start it.
  888.  */
  889.  
  890. add_timer(&i2ob_timer);
  891. return;
  892. }
  893. }
  894. /*
  895.  * Everything ok, so pull from kernel queue onto our queue
  896.  */
  897. req->errors = 0;
  898. blkdev_dequeue_request(req);
  899. req->waiting = NULL;
  900. ireq = i2ob_queues[dev->unit]->i2ob_qhead;
  901. i2ob_queues[dev->unit]->i2ob_qhead = ireq->next;
  902. ireq->req = req;
  903. i2ob_send(m, dev, ireq, i2ob[unit].start_sect, (unit&0xF0));
  904. }
  905. }
  906. /*
  907.  * SCSI-CAM for ioctl geometry mapping
  908.  * Duplicated with SCSI - this should be moved into somewhere common
  909.  * perhaps genhd ?
  910.  *
  911.  * LBA -> CHS mapping table taken from:
  912.  *
  913.  * "Incorporating the I2O Architecture into BIOS for Intel Architecture 
  914.  *  Platforms" 
  915.  *
  916.  * This is an I2O document that is only available to I2O members,
  917.  * not developers.
  918.  *
  919.  * From my understanding, this is how all the I2O cards do this
  920.  *
  921.  * Disk Size      | Sectors | Heads | Cylinders
  922.  * ---------------+---------+-------+-------------------
  923.  * 1 < X <= 528M  | 63      | 16    | X/(63 * 16 * 512)
  924.  * 528M < X <= 1G | 63      | 32    | X/(63 * 32 * 512)
  925.  * 1 < X <528M    | 63      | 16    | X/(63 * 16 * 512)
  926.  * 1 < X <528M    | 63      | 16    | X/(63 * 16 * 512)
  927.  *
  928.  */
  929. #define BLOCK_SIZE_528M 1081344
  930. #define BLOCK_SIZE_1G 2097152
  931. #define BLOCK_SIZE_21G 4403200
  932. #define BLOCK_SIZE_42G 8806400
  933. #define BLOCK_SIZE_84G 17612800
  934. static void i2o_block_biosparam(
  935. unsigned long capacity,
  936. unsigned short *cyls,
  937. unsigned char *hds,
  938. unsigned char *secs) 
  939. unsigned long heads, sectors, cylinders; 
  940. sectors = 63L;       /* Maximize sectors per track */ 
  941. if(capacity <= BLOCK_SIZE_528M)
  942. heads = 16;
  943. else if(capacity <= BLOCK_SIZE_1G)
  944. heads = 32;
  945. else if(capacity <= BLOCK_SIZE_21G)
  946. heads = 64;
  947. else if(capacity <= BLOCK_SIZE_42G)
  948. heads = 128;
  949. else
  950. heads = 255;
  951. cylinders = capacity / (heads * sectors);
  952. *cyls = (unsigned short) cylinders; /* Stuff return values */ 
  953. *secs = (unsigned char) sectors; 
  954. *hds  = (unsigned char) heads; 
  955. }
  956. /*
  957.  * Rescan the partition tables
  958.  */
  959.  
  960. static int do_i2ob_revalidate(kdev_t dev, int maxu)
  961. {
  962. int minor=MINOR(dev);
  963. int i;
  964. minor&=0xF0;
  965. i2ob_dev[minor].refcnt++;
  966. if(i2ob_dev[minor].refcnt>maxu+1)
  967. {
  968. i2ob_dev[minor].refcnt--;
  969. return -EBUSY;
  970. }
  971. for( i = 15; i>=0 ; i--)
  972. {
  973. int m = minor+i;
  974. invalidate_device(MKDEV(MAJOR_NR, m), 1);
  975. i2ob_gendisk.part[m].start_sect = 0;
  976. i2ob_gendisk.part[m].nr_sects = 0;
  977. }
  978. /*
  979.  * Do a physical check and then reconfigure
  980.  */
  981.  
  982. i2ob_install_device(i2ob_dev[minor].controller, i2ob_dev[minor].i2odev,
  983. minor);
  984. i2ob_dev[minor].refcnt--;
  985. return 0;
  986. }
  987. /*
  988.  * Issue device specific ioctl calls.
  989.  */
  990. static int i2ob_ioctl(struct inode *inode, struct file *file,
  991.      unsigned int cmd, unsigned long arg)
  992. {
  993. struct i2ob_device *dev;
  994. int minor;
  995. /* Anyone capable of this syscall can do *real bad* things */
  996. if (!capable(CAP_SYS_ADMIN))
  997. return -EPERM;
  998. if (!inode)
  999. return -EINVAL;
  1000. minor = MINOR(inode->i_rdev);
  1001. if (minor >= (MAX_I2OB<<4))
  1002. return -ENODEV;
  1003. dev = &i2ob_dev[minor];
  1004. switch (cmd) {
  1005. case BLKGETSIZE:
  1006. return put_user(i2ob[minor].nr_sects, (long *) arg);
  1007. case BLKGETSIZE64:
  1008. return put_user((u64)i2ob[minor].nr_sects << 9, (u64 *)arg);
  1009. case HDIO_GETGEO:
  1010. {
  1011. struct hd_geometry g;
  1012. int u=minor&0xF0;
  1013. i2o_block_biosparam(i2ob_sizes[u]<<1, 
  1014. &g.cylinders, &g.heads, &g.sectors);
  1015. g.start = i2ob[minor].start_sect;
  1016. return copy_to_user((void *)arg,&g, sizeof(g))?-EFAULT:0;
  1017. }
  1018. case BLKRRPART:
  1019. if(!capable(CAP_SYS_ADMIN))
  1020. return -EACCES;
  1021. return do_i2ob_revalidate(inode->i_rdev,1);
  1022. case BLKFLSBUF:
  1023. case BLKROSET:
  1024. case BLKROGET:
  1025. case BLKRASET:
  1026. case BLKRAGET:
  1027. case BLKPG:
  1028. return blk_ioctl(inode->i_rdev, cmd, arg);
  1029. default:
  1030. return -EINVAL;
  1031. }
  1032. }
  1033. /*
  1034.  * Close the block device down
  1035.  */
  1036.  
  1037. static int i2ob_release(struct inode *inode, struct file *file)
  1038. {
  1039. struct i2ob_device *dev;
  1040. int minor;
  1041. minor = MINOR(inode->i_rdev);
  1042. if (minor >= (MAX_I2OB<<4))
  1043. return -ENODEV;
  1044. dev = &i2ob_dev[(minor&0xF0)];
  1045. /*
  1046.  * This is to deail with the case of an application
  1047.  * opening a device and then the device dissapears while
  1048.  * it's in use, and then the application tries to release
  1049.  * it.  ex: Unmounting a deleted RAID volume at reboot. 
  1050.  * If we send messages, it will just cause FAILs since
  1051.  * the TID no longer exists.
  1052.  */
  1053. if(!dev->i2odev)
  1054. return 0;
  1055. if (dev->refcnt <= 0)
  1056. printk(KERN_ALERT "i2ob_release: refcount(%d) <= 0n", dev->refcnt);
  1057. dev->refcnt--;
  1058. if(dev->refcnt==0)
  1059. {
  1060. /*
  1061.  * Flush the onboard cache on unmount
  1062.  */
  1063. u32 msg[5];
  1064. int *query_done = &dev->done_flag;
  1065. msg[0] = FIVE_WORD_MSG_SIZE|SGL_OFFSET_0;
  1066. msg[1] = I2O_CMD_BLOCK_CFLUSH<<24|HOST_TID<<12|dev->tid;
  1067. msg[2] = i2ob_context|0x40000000;
  1068. msg[3] = (u32)query_done;
  1069. msg[4] = 60<<16;
  1070. DEBUG("Flushing...");
  1071. i2o_post_wait(dev->controller, msg, 20, 60);
  1072. /*
  1073.  * Unlock the media
  1074.  */
  1075. msg[0] = FIVE_WORD_MSG_SIZE|SGL_OFFSET_0;
  1076. msg[1] = I2O_CMD_BLOCK_MUNLOCK<<24|HOST_TID<<12|dev->tid;
  1077. msg[2] = i2ob_context|0x40000000;
  1078. msg[3] = (u32)query_done;
  1079. msg[4] = -1;
  1080. DEBUG("Unlocking...");
  1081. i2o_post_wait(dev->controller, msg, 20, 2);
  1082. DEBUG("Unlocked.n");
  1083. /*
  1084.    * Now unclaim the device.
  1085.  */
  1086. if (i2o_release_device(dev->i2odev, &i2o_block_handler))
  1087. printk(KERN_ERR "i2ob_release: controller rejected unclaim.n");
  1088. DEBUG("Unclaimn");
  1089. }
  1090. return 0;
  1091. }
  1092. /*
  1093.  * Open the block device.
  1094.  */
  1095.  
  1096. static int i2ob_open(struct inode *inode, struct file *file)
  1097. {
  1098. int minor;
  1099. struct i2ob_device *dev;
  1100. if (!inode)
  1101. return -EINVAL;
  1102. minor = MINOR(inode->i_rdev);
  1103. if (minor >= MAX_I2OB<<4)
  1104. return -ENODEV;
  1105. dev=&i2ob_dev[(minor&0xF0)];
  1106. if(!dev->i2odev)
  1107. return -ENODEV;
  1108. if(dev->refcnt++==0)
  1109. u32 msg[6];
  1110. DEBUG("Claim ");
  1111. if(i2o_claim_device(dev->i2odev, &i2o_block_handler))
  1112. {
  1113. dev->refcnt--;
  1114. printk(KERN_INFO "I2O Block: Could not open devicen");
  1115. return -EBUSY;
  1116. }
  1117. DEBUG("Claimed ");
  1118. /*
  1119.  * Mount the media if needed. Note that we don't use
  1120.  * the lock bit. Since we have to issue a lock if it
  1121.  * refuses a mount (quite possible) then we might as
  1122.  * well just send two messages out.
  1123.  */
  1124. msg[0] = FIVE_WORD_MSG_SIZE|SGL_OFFSET_0;
  1125. msg[1] = I2O_CMD_BLOCK_MMOUNT<<24|HOST_TID<<12|dev->tid;
  1126. msg[4] = -1;
  1127. msg[5] = 0;
  1128. DEBUG("Mount ");
  1129. i2o_post_wait(dev->controller, msg, 24, 2);
  1130. /*
  1131.  * Lock the media
  1132.  */
  1133. msg[0] = FIVE_WORD_MSG_SIZE|SGL_OFFSET_0;
  1134. msg[1] = I2O_CMD_BLOCK_MLOCK<<24|HOST_TID<<12|dev->tid;
  1135. msg[4] = -1;
  1136. DEBUG("Lock ");
  1137. i2o_post_wait(dev->controller, msg, 20, 2);
  1138. DEBUG("Ready.n");
  1139. }
  1140. return 0;
  1141. }
  1142. /*
  1143.  * Issue a device query
  1144.  */
  1145.  
  1146. static int i2ob_query_device(struct i2ob_device *dev, int table, 
  1147. int field, void *buf, int buflen)
  1148. {
  1149. return i2o_query_scalar(dev->controller, dev->tid,
  1150. table, field, buf, buflen);
  1151. }
  1152. /*
  1153.  * Install the I2O block device we found.
  1154.  */
  1155.  
  1156. static int i2ob_install_device(struct i2o_controller *c, struct i2o_device *d, int unit)
  1157. {
  1158. u64 size;
  1159. u32 blocksize;
  1160. u32 limit;
  1161. u8 type;
  1162. u32 flags, status;
  1163. struct i2ob_device *dev=&i2ob_dev[unit];
  1164. int i;
  1165. /*
  1166.  * For logging purposes...
  1167.  */
  1168. printk(KERN_INFO "i2ob: Installing tid %d device at unit %dn", 
  1169. d->lct_data.tid, unit);
  1170. /*
  1171.  * Ask for the current media data. If that isn't supported
  1172.  * then we ask for the device capacity data
  1173.  */
  1174. if(i2ob_query_device(dev, 0x0004, 1, &blocksize, 4) != 0
  1175.   || i2ob_query_device(dev, 0x0004, 0, &size, 8) !=0 )
  1176. {
  1177. i2ob_query_device(dev, 0x0000, 3, &blocksize, 4);
  1178. i2ob_query_device(dev, 0x0000, 4, &size, 8);
  1179. }
  1180. i2ob_query_device(dev, 0x0000, 5, &flags, 4);
  1181. i2ob_query_device(dev, 0x0000, 6, &status, 4);
  1182. i2ob_sizes[unit] = (int)(size>>10);
  1183. for(i=unit; i <= unit+15 ; i++)
  1184. i2ob_hardsizes[i] = blocksize;
  1185. i2ob_gendisk.part[unit].nr_sects = size>>9;
  1186. i2ob[unit].nr_sects = (int)(size>>9);
  1187. /* Set limit based on inbound frame size */
  1188. limit = (d->controller->status_block->inbound_frame_size - 8)/2;
  1189. limit = limit<<9;
  1190. /*
  1191.  * Max number of Scatter-Gather Elements
  1192.  */
  1193. for(i=unit;i<=unit+15;i++)
  1194. {
  1195. i2ob_max_sectors[i] = 256;
  1196. i2ob_dev[i].max_segments = (d->controller->status_block->inbound_frame_size - 8)/2;
  1197. if(d->controller->type == I2O_TYPE_PCI && d->controller->bus.pci.queue_buggy == 2)
  1198. i2ob_dev[i].depth = 32;
  1199. if(d->controller->type == I2O_TYPE_PCI && d->controller->bus.pci.queue_buggy == 1)
  1200. {
  1201. i2ob_max_sectors[i] = 32;
  1202. i2ob_dev[i].max_segments = 8;
  1203. i2ob_dev[i].depth = 4;
  1204. }
  1205. if(d->controller->type == I2O_TYPE_PCI && d->controller->bus.pci.short_req)
  1206. {
  1207. i2ob_max_sectors[i] = 8;
  1208. i2ob_dev[i].max_segments = 8;
  1209. }
  1210. }
  1211. sprintf(d->dev_name, "%s%c", i2ob_gendisk.major_name, 'a' + (unit>>4));
  1212. printk(KERN_INFO "%s: Max segments %d, queue depth %d, byte limit %d.n",
  1213.  d->dev_name, i2ob_dev[unit].max_segments, i2ob_dev[unit].depth, limit);
  1214. i2ob_query_device(dev, 0x0000, 0, &type, 1);
  1215. printk(KERN_INFO "%s: ", d->dev_name);
  1216. switch(type)
  1217. {
  1218. case 0: printk("Disk Storage");break;
  1219. case 4: printk("WORM");break;
  1220. case 5: printk("CD-ROM");break;
  1221. case 7: printk("Optical device");break;
  1222. default:
  1223. printk("Type %d", type);
  1224. }
  1225. if(status&(1<<10))
  1226. printk("(RAID)");
  1227. if(((flags & (1<<3)) && !(status & (1<<3))) ||
  1228.    ((flags & (1<<4)) && !(status & (1<<4))))
  1229. {
  1230. printk(KERN_INFO " Not loaded.n");
  1231. return 1;
  1232. }
  1233. printk(": %dMB, %d byte sectors",
  1234. (int)(size>>20), blocksize);
  1235. if(status&(1<<0))
  1236. {
  1237. u32 cachesize;
  1238. i2ob_query_device(dev, 0x0003, 0, &cachesize, 4);
  1239. cachesize>>=10;
  1240. if(cachesize>4095)
  1241. printk(", %dMb cache", cachesize>>10);
  1242. else
  1243. printk(", %dKb cache", cachesize);
  1244. }
  1245. printk(".n");
  1246. printk(KERN_INFO "%s: Maximum sectors/read set to %d.n", 
  1247. d->dev_name, i2ob_max_sectors[unit]);
  1248. /* 
  1249.  * If this is the first I2O block device found on this IOP,
  1250.  * we need to initialize all the queue data structures
  1251.  * before any I/O can be performed. If it fails, this
  1252.  * device is useless.
  1253.  */
  1254. if(!i2ob_queues[c->unit]) {
  1255. if(i2ob_init_iop(c->unit))
  1256. return 1;
  1257. }
  1258. /* 
  1259.  * This will save one level of lookup/indirection in critical 
  1260.  * code so that we can directly get the queue ptr from the
  1261.  * device instead of having to go the IOP data structure.
  1262.  */
  1263. dev->req_queue = &i2ob_queues[c->unit]->req_queue;
  1264. grok_partitions(&i2ob_gendisk, unit>>4, 1<<4, (long)(size>>9));
  1265. /*
  1266.  * Register for the events we're interested in and that the
  1267.  * device actually supports.
  1268.  */
  1269. i2o_event_register(c, d->lct_data.tid, i2ob_context, unit, 
  1270. (I2OB_EVENT_MASK & d->lct_data.event_capabilities));
  1271. return 0;
  1272. }
  1273. /*
  1274.  * Initialize IOP specific queue structures.  This is called
  1275.  * once for each IOP that has a block device sitting behind it.
  1276.  */
  1277. static int i2ob_init_iop(unsigned int unit)
  1278. {
  1279. int i;
  1280. i2ob_queues[unit] = (struct i2ob_iop_queue*) kmalloc(sizeof(struct i2ob_iop_queue), GFP_ATOMIC);
  1281. if(!i2ob_queues[unit])
  1282. {
  1283. printk(KERN_WARNING "Could not allocate request queue for I2O block device!n");
  1284. return -1;
  1285. }
  1286. for(i = 0; i< MAX_I2OB_DEPTH; i++)
  1287. {
  1288. i2ob_queues[unit]->request_queue[i].next =  &i2ob_queues[unit]->request_queue[i+1];
  1289. i2ob_queues[unit]->request_queue[i].num = i;
  1290. }
  1291. /* Queue is MAX_I2OB + 1... */
  1292. i2ob_queues[unit]->request_queue[i].next = NULL;
  1293. i2ob_queues[unit]->i2ob_qhead = &i2ob_queues[unit]->request_queue[0];
  1294. atomic_set(&i2ob_queues[unit]->queue_depth, 0);
  1295. blk_init_queue(&i2ob_queues[unit]->req_queue, i2ob_request);
  1296. blk_queue_headactive(&i2ob_queues[unit]->req_queue, 0);
  1297. i2ob_queues[unit]->req_queue.back_merge_fn = i2ob_back_merge;
  1298. i2ob_queues[unit]->req_queue.front_merge_fn = i2ob_front_merge;
  1299. i2ob_queues[unit]->req_queue.merge_requests_fn = i2ob_merge_requests;
  1300. i2ob_queues[unit]->req_queue.queuedata = &i2ob_queues[unit];
  1301. return 0;
  1302. }
  1303. /*
  1304.  * Get the request queue for the given device.
  1305.  */
  1306. static request_queue_t* i2ob_get_queue(kdev_t dev)
  1307. {
  1308. int unit = MINOR(dev)&0xF0;
  1309. return i2ob_dev[unit].req_queue;
  1310. }
  1311. /*
  1312.  * Probe the I2O subsytem for block class devices
  1313.  */
  1314. static void i2ob_scan(int bios)
  1315. {
  1316. int i;
  1317. int warned = 0;
  1318. struct i2o_device *d, *b=NULL;
  1319. struct i2o_controller *c;
  1320. struct i2ob_device *dev;
  1321. for(i=0; i< MAX_I2O_CONTROLLERS; i++)
  1322. {
  1323. c=i2o_find_controller(i);
  1324. if(c==NULL)
  1325. continue;
  1326. /*
  1327.  *    The device list connected to the I2O Controller is doubly linked
  1328.  * Here we traverse the end of the list , and start claiming devices
  1329.  * from that end. This assures that within an I2O controller atleast
  1330.  * the newly created volumes get claimed after the older ones, thus
  1331.  * mapping to same major/minor (and hence device file name) after 
  1332.  * every reboot.
  1333.  * The exception being: 
  1334.  * 1. If there was a TID reuse.
  1335.  * 2. There was more than one I2O controller. 
  1336.  */
  1337. if(!bios)
  1338. {
  1339. for (d=c->devices;d!=NULL;d=d->next)
  1340. if(d->next == NULL)
  1341. b = d;
  1342. }
  1343. else
  1344. b = c->devices;
  1345. while(b != NULL)
  1346. {
  1347. d=b;
  1348. if(bios)
  1349. b = b->next;
  1350. else
  1351. b = b->prev;
  1352. if(d->lct_data.class_id!=I2O_CLASS_RANDOM_BLOCK_STORAGE)
  1353. continue;
  1354. if(d->lct_data.user_tid != 0xFFF)
  1355. continue;
  1356. if(bios)
  1357. {
  1358. if(d->lct_data.bios_info != 0x80)
  1359. continue;
  1360. printk(KERN_INFO "Claiming as Boot device: Controller %d, TID %dn", c->unit, d->lct_data.tid);
  1361. }
  1362. else
  1363. {
  1364. if(d->lct_data.bios_info == 0x80)
  1365. continue; /*Already claimed on pass 1 */
  1366. }
  1367. if(i2o_claim_device(d, &i2o_block_handler))
  1368. {
  1369. printk(KERN_WARNING "i2o_block: Controller %d, TID %dn", c->unit,
  1370. d->lct_data.tid);
  1371. printk(KERN_WARNING "t%sevice refused claim! Skipping installationn", bios?"Boot d":"D");
  1372. continue;
  1373. }
  1374. if(scan_unit<MAX_I2OB<<4)
  1375. {
  1376.   /*
  1377.  * Get the device and fill in the
  1378.  * Tid and controller.
  1379.  */
  1380. dev=&i2ob_dev[scan_unit];
  1381. dev->i2odev = d; 
  1382. dev->controller = c;
  1383. dev->unit = c->unit;
  1384. dev->tid = d->lct_data.tid;
  1385. if(i2ob_install_device(c,d,scan_unit))
  1386. printk(KERN_WARNING "Could not install I2O block devicen");
  1387. else
  1388. {
  1389. scan_unit+=16;
  1390. i2ob_dev_count++;
  1391. /* We want to know when device goes away */
  1392. i2o_device_notify_on(d, &i2o_block_handler);
  1393. }
  1394. }
  1395. else
  1396. {
  1397. if(!warned++)
  1398. printk(KERN_WARNING "i2o_block: too many device, registering only %d.n", scan_unit>>4);
  1399. }
  1400. i2o_release_device(d, &i2o_block_handler);
  1401. }
  1402. i2o_unlock_controller(c);
  1403. }
  1404. }
  1405. static void i2ob_probe(void)
  1406. {
  1407. /*
  1408.  *      Some overhead/redundancy involved here, while trying to
  1409.  *      claim the first boot volume encountered as /dev/i2o/hda
  1410.  *      everytime. All the i2o_controllers are searched and the
  1411.  *      first i2o block device marked as bootable is claimed
  1412.  *      If an I2O block device was booted off , the bios sets
  1413.  *      its bios_info field to 0x80, this what we search for.
  1414.  *      Assuming that the bootable volume is /dev/i2o/hda
  1415.  *      everytime will prevent any kernel panic while mounting
  1416.  *      root partition
  1417.  */
  1418. printk(KERN_INFO "i2o_block: Checking for Boot device...n");
  1419. i2ob_scan(1);
  1420. /*
  1421.  *      Now the remainder.
  1422.  */
  1423. printk(KERN_INFO "i2o_block: Checking for I2O Block devices...n");
  1424. i2ob_scan(0);
  1425. }
  1426. /*
  1427.  * New device notification handler.  Called whenever a new
  1428.  * I2O block storage device is added to the system.
  1429.  * 
  1430.  * Should we spin lock around this to keep multiple devs from 
  1431.  * getting updated at the same time? 
  1432.  * 
  1433.  */
  1434. void i2ob_new_device(struct i2o_controller *c, struct i2o_device *d)
  1435. {
  1436. struct i2ob_device *dev;
  1437. int unit = 0;
  1438. printk(KERN_INFO "i2o_block: New device detectedn");
  1439. printk(KERN_INFO "   Controller %d Tid %dn",c->unit, d->lct_data.tid);
  1440. /* Check for available space */
  1441. if(i2ob_dev_count>=MAX_I2OB<<4)
  1442. {
  1443. printk(KERN_ERR "i2o_block: No more devices allowed!n");
  1444. return;
  1445. }
  1446. for(unit = 0; unit < (MAX_I2OB<<4); unit += 16)
  1447. {
  1448. if(!i2ob_dev[unit].i2odev)
  1449. break;
  1450. }
  1451. if(i2o_claim_device(d, &i2o_block_handler))
  1452. {
  1453. printk(KERN_INFO 
  1454. "i2o_block: Unable to claim device. Installation abortedn");
  1455. return;
  1456. }
  1457. dev = &i2ob_dev[unit];
  1458. dev->i2odev = d; 
  1459. dev->controller = c;
  1460. dev->tid = d->lct_data.tid;
  1461. if(i2ob_install_device(c,d,unit))
  1462. printk(KERN_ERR "i2o_block: Could not install new devicen");
  1463. else
  1464. {
  1465. i2ob_dev_count++;
  1466. i2o_device_notify_on(d, &i2o_block_handler);
  1467. }
  1468. i2o_release_device(d, &i2o_block_handler);
  1469.  
  1470. return;
  1471. }
  1472. /*
  1473.  * Deleted device notification handler.  Called when a device we
  1474.  * are talking to has been deleted by the user or some other
  1475.  * mysterious fource outside the kernel.
  1476.  */
  1477. void i2ob_del_device(struct i2o_controller *c, struct i2o_device *d)
  1478. {
  1479. int unit = 0;
  1480. int i = 0;
  1481. unsigned long flags;
  1482. spin_lock_irqsave(&io_request_lock, flags);
  1483. /*
  1484.  * Need to do this...we somtimes get two events from the IRTOS
  1485.  * in a row and that causes lots of problems.
  1486.  */
  1487. i2o_device_notify_off(d, &i2o_block_handler);
  1488. printk(KERN_INFO "I2O Block Device Deletedn");
  1489. for(unit = 0; unit < MAX_I2OB<<4; unit += 16)
  1490. {
  1491. if(i2ob_dev[unit].i2odev == d)
  1492. {
  1493. printk(KERN_INFO "  /dev/%s: Controller %d Tid %dn", 
  1494. d->dev_name, c->unit, d->lct_data.tid);
  1495. break;
  1496. }
  1497. }
  1498. if(unit >= MAX_I2OB<<4)
  1499. {
  1500. printk(KERN_ERR "i2ob_del_device called, but not in dev table!n");
  1501. spin_unlock_irqrestore(&io_request_lock, flags);
  1502. return;
  1503. }
  1504. /* 
  1505.  * This will force errors when i2ob_get_queue() is called
  1506.  * by the kenrel.
  1507.  */
  1508. i2ob_dev[unit].req_queue = NULL;
  1509. for(i = unit; i <= unit+15; i++)
  1510. {
  1511. i2ob_dev[i].i2odev = NULL;
  1512. i2ob_sizes[i] = 0;
  1513. i2ob_hardsizes[i] = 0;
  1514. i2ob_max_sectors[i] = 0;
  1515. i2ob[i].nr_sects = 0;
  1516. i2ob_gendisk.part[i].nr_sects = 0;
  1517. }
  1518. spin_unlock_irqrestore(&io_request_lock, flags);
  1519. /*
  1520.  * Decrease usage count for module
  1521.  */
  1522. while(i2ob_dev[unit].refcnt--)
  1523. MOD_DEC_USE_COUNT;
  1524. i2ob_dev[unit].refcnt = 0;
  1525. i2ob_dev[i].tid = 0;
  1526. /* 
  1527.  * Do we need this?
  1528.  * The media didn't really change...the device is just gone
  1529.  */
  1530. i2ob_media_change_flag[unit] = 1;
  1531. i2ob_dev_count--;
  1532. }
  1533. /*
  1534.  * Have we seen a media change ?
  1535.  */
  1536. static int i2ob_media_change(kdev_t dev)
  1537. {
  1538. int i=MINOR(dev);
  1539. i>>=4;
  1540. if(i2ob_media_change_flag[i])
  1541. {
  1542. i2ob_media_change_flag[i]=0;
  1543. return 1;
  1544. }
  1545. return 0;
  1546. }
  1547. static int i2ob_revalidate(kdev_t dev)
  1548. {
  1549. return do_i2ob_revalidate(dev, 0);
  1550. }
  1551. /*
  1552.  * Reboot notifier.  This is called by i2o_core when the system
  1553.  * shuts down.
  1554.  */
  1555. static void i2ob_reboot_event(void)
  1556. {
  1557. int i;
  1558. for(i=0;i<MAX_I2OB;i++)
  1559. {
  1560. struct i2ob_device *dev=&i2ob_dev[(i<<4)];
  1561. if(dev->refcnt!=0)
  1562. {
  1563. /*
  1564.  * Flush the onboard cache
  1565.  */
  1566. u32 msg[5];
  1567. int *query_done = &dev->done_flag;
  1568. msg[0] = FIVE_WORD_MSG_SIZE|SGL_OFFSET_0;
  1569. msg[1] = I2O_CMD_BLOCK_CFLUSH<<24|HOST_TID<<12|dev->tid;
  1570. msg[2] = i2ob_context|0x40000000;
  1571. msg[3] = (u32)query_done;
  1572. msg[4] = 60<<16;
  1573. DEBUG("Flushing...");
  1574. i2o_post_wait(dev->controller, msg, 20, 60);
  1575. DEBUG("Unlocking...");
  1576. /*
  1577.  * Unlock the media
  1578.  */
  1579. msg[0] = FIVE_WORD_MSG_SIZE|SGL_OFFSET_0;
  1580. msg[1] = I2O_CMD_BLOCK_MUNLOCK<<24|HOST_TID<<12|dev->tid;
  1581. msg[2] = i2ob_context|0x40000000;
  1582. msg[3] = (u32)query_done;
  1583. msg[4] = -1;
  1584. i2o_post_wait(dev->controller, msg, 20, 2);
  1585. DEBUG("Unlocked.n");
  1586. }
  1587. }
  1588. }
  1589. static struct block_device_operations i2ob_fops =
  1590. {
  1591. owner: THIS_MODULE,
  1592. open: i2ob_open,
  1593. release: i2ob_release,
  1594. ioctl: i2ob_ioctl,
  1595. check_media_change: i2ob_media_change,
  1596. revalidate: i2ob_revalidate,
  1597. };
  1598. static struct gendisk i2ob_gendisk = 
  1599. {
  1600. major: MAJOR_NR,
  1601. major_name: "i2o/hd",
  1602. minor_shift: 4,
  1603. max_p: 1<<4,
  1604. part: i2ob,
  1605. sizes: i2ob_sizes,
  1606. nr_real: MAX_I2OB,
  1607. fops: &i2ob_fops,
  1608. };
  1609. /*
  1610.  * And here should be modules and kernel interface 
  1611.  *  (Just smiley confuses emacs :-)
  1612.  */
  1613. #ifdef MODULE
  1614. #define i2o_block_init init_module
  1615. #endif
  1616. int i2o_block_init(void)
  1617. {
  1618. int i;
  1619. printk(KERN_INFO "I2O Block Storage OSM v0.9n");
  1620. printk(KERN_INFO "   (c) Copyright 1999-2001 Red Hat Software.n");
  1621. /*
  1622.  * Register the block device interfaces
  1623.  */
  1624. if (register_blkdev(MAJOR_NR, "i2o_block", &i2ob_fops)) {
  1625. printk(KERN_ERR "Unable to get major number %d for i2o_blockn",
  1626.        MAJOR_NR);
  1627. return -EIO;
  1628. }
  1629. #ifdef MODULE
  1630. printk(KERN_INFO "i2o_block: registered device at major %dn", MAJOR_NR);
  1631. #endif
  1632. /*
  1633.  * Now fill in the boiler plate
  1634.  */
  1635.  
  1636. blksize_size[MAJOR_NR] = i2ob_blksizes;
  1637. hardsect_size[MAJOR_NR] = i2ob_hardsizes;
  1638. blk_size[MAJOR_NR] = i2ob_sizes;
  1639. max_sectors[MAJOR_NR] = i2ob_max_sectors;
  1640. blk_dev[MAJOR_NR].queue = i2ob_get_queue;
  1641. blk_init_queue(BLK_DEFAULT_QUEUE(MAJOR_NR), i2ob_request);
  1642. blk_queue_headactive(BLK_DEFAULT_QUEUE(MAJOR_NR), 0);
  1643. for (i = 0; i < MAX_I2OB << 4; i++) {
  1644. i2ob_dev[i].refcnt = 0;
  1645. i2ob_dev[i].flags = 0;
  1646. i2ob_dev[i].controller = NULL;
  1647. i2ob_dev[i].i2odev = NULL;
  1648. i2ob_dev[i].tid = 0;
  1649. i2ob_dev[i].head = NULL;
  1650. i2ob_dev[i].tail = NULL;
  1651. i2ob_dev[i].depth = MAX_I2OB_DEPTH;
  1652. i2ob_blksizes[i] = 1024;
  1653. i2ob_max_sectors[i] = 2;
  1654. }
  1655. /*
  1656.  * Set up the queue
  1657.  */
  1658. for(i = 0; i < MAX_I2O_CONTROLLERS; i++)
  1659. {
  1660. i2ob_queues[i] = NULL;
  1661. }
  1662. /*
  1663.  * Timers
  1664.  */
  1665.  
  1666. init_timer(&i2ob_timer);
  1667. i2ob_timer.function = i2ob_timer_handler;
  1668. i2ob_timer.data = 0;
  1669. /*
  1670.  * Register the OSM handler as we will need this to probe for
  1671.  * drives, geometry and other goodies.
  1672.  */
  1673. if(i2o_install_handler(&i2o_block_handler)<0)
  1674. {
  1675. unregister_blkdev(MAJOR_NR, "i2o_block");
  1676. blk_cleanup_queue(BLK_DEFAULT_QUEUE(MAJOR_NR));
  1677. printk(KERN_ERR "i2o_block: unable to register OSM.n");
  1678. return -EINVAL;
  1679. }
  1680. i2ob_context = i2o_block_handler.context;  
  1681. /*
  1682.  * Initialize event handling thread
  1683.  */
  1684. init_MUTEX_LOCKED(&i2ob_evt_sem);
  1685. evt_pid = kernel_thread(i2ob_evt, NULL, CLONE_SIGHAND);
  1686. if(evt_pid < 0)
  1687. {
  1688. printk(KERN_ERR 
  1689. "i2o_block: Could not initialize event thread.  Abortingn");
  1690. i2o_remove_handler(&i2o_block_handler);
  1691. return 0;
  1692. }
  1693. /*
  1694.  * Finally see what is actually plugged in to our controllers
  1695.  */
  1696. for (i = 0; i < MAX_I2OB; i++)
  1697. register_disk(&i2ob_gendisk, MKDEV(MAJOR_NR,i<<4), 1<<4,
  1698. &i2ob_fops, 0);
  1699. i2ob_probe();
  1700. /*
  1701.  * Adding i2ob_gendisk into the gendisk list.
  1702.  */
  1703. add_gendisk(&i2ob_gendisk);
  1704. return 0;
  1705. }
  1706. #ifdef MODULE
  1707. EXPORT_NO_SYMBOLS;
  1708. MODULE_AUTHOR("Red Hat Software");
  1709. MODULE_DESCRIPTION("I2O Block Device OSM");
  1710. MODULE_LICENSE("GPL");
  1711. void cleanup_module(void)
  1712. {
  1713. int i;
  1714. if(evt_running) {
  1715. printk(KERN_INFO "Killing I2O block threads...");
  1716. i = kill_proc(evt_pid, SIGTERM, 1);
  1717. if(!i) {
  1718. printk("waiting...");
  1719. }
  1720. /* Be sure it died */
  1721. wait_for_completion(&i2ob_thread_dead);
  1722. printk("done.n");
  1723. }
  1724. /*
  1725.  * Unregister for updates from any devices..otherwise we still
  1726.  * get them and the core jumps to random memory :O
  1727.  */
  1728. if(i2ob_dev_count) {
  1729. struct i2o_device *d;
  1730. for(i = 0; i < MAX_I2OB; i++)
  1731. if((d=i2ob_dev[i<<4].i2odev)) {
  1732. i2o_device_notify_off(d, &i2o_block_handler);
  1733. i2o_event_register(d->controller, d->lct_data.tid, 
  1734. i2ob_context, i<<4, 0);
  1735. }
  1736. }
  1737. /*
  1738.  * We may get further callbacks for ourself. The i2o_core
  1739.  * code handles this case reasonably sanely. The problem here
  1740.  * is we shouldn't get them .. but a couple of cards feel 
  1741.  * obliged to tell us stuff we dont care about.
  1742.  *
  1743.  * This isnt ideal at all but will do for now.
  1744.  */
  1745.  
  1746. set_current_state(TASK_UNINTERRUPTIBLE);
  1747. schedule_timeout(HZ);
  1748. /*
  1749.  * Flush the OSM
  1750.  */
  1751. i2o_remove_handler(&i2o_block_handler);
  1752.  
  1753. /*
  1754.  * Return the block device
  1755.  */
  1756. if (unregister_blkdev(MAJOR_NR, "i2o_block") != 0)
  1757. printk("i2o_block: cleanup_module failedn");
  1758. /*
  1759.  * free request queue
  1760.  */
  1761. blk_cleanup_queue(BLK_DEFAULT_QUEUE(MAJOR_NR));
  1762. del_gendisk(&i2ob_gendisk);
  1763. }
  1764. #endif