Loading...
Note: File does not exist in v6.2.
1/*
2 * Block OSM
3 *
4 * Copyright (C) 1999-2002 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 modify it
9 * under the terms of the GNU General Public License as published by the
10 * Free Software Foundation; either version 2 of the License, or (at your
11 * option) any later version.
12 *
13 * This program is distributed in the hope that it will be useful, but
14 * WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
16 * General Public License for more details.
17 *
18 * For the purpose of avoiding doubt the preferred form of the work
19 * for making modifications shall be a standards compliant form such
20 * gzipped tar and not one requiring a proprietary or patent encumbered
21 * tool to unpack.
22 *
23 * Fixes/additions:
24 * Steve Ralston:
25 * Multiple device handling error fixes,
26 * Added a queue depth.
27 * Alan Cox:
28 * FC920 has an rmw bug. Dont or in the end marker.
29 * Removed queue walk, fixed for 64bitness.
30 * Rewrote much of the code over time
31 * Added indirect block lists
32 * Handle 64K limits on many controllers
33 * Don't use indirects on the Promise (breaks)
34 * Heavily chop down the queue depths
35 * Deepak Saxena:
36 * Independent queues per IOP
37 * Support for dynamic device creation/deletion
38 * Code cleanup
39 * Support for larger I/Os through merge* functions
40 * (taken from DAC960 driver)
41 * Boji T Kannanthanam:
42 * Set the I2O Block devices to be detected in increasing
43 * order of TIDs during boot.
44 * Search and set the I2O block device that we boot off
45 * from as the first device to be claimed (as /dev/i2o/hda)
46 * Properly attach/detach I2O gendisk structure from the
47 * system gendisk list. The I2O block devices now appear in
48 * /proc/partitions.
49 * Markus Lidel <Markus.Lidel@shadowconnect.com>:
50 * Minor bugfixes for 2.6.
51 */
52
53#include <linux/module.h>
54#include <linux/slab.h>
55#include <linux/i2o.h>
56#include <linux/mutex.h>
57
58#include <linux/mempool.h>
59
60#include <linux/genhd.h>
61#include <linux/blkdev.h>
62#include <linux/hdreg.h>
63
64#include <scsi/scsi.h>
65
66#include "i2o_block.h"
67
68#define OSM_NAME "block-osm"
69#define OSM_VERSION "1.325"
70#define OSM_DESCRIPTION "I2O Block Device OSM"
71
72static DEFINE_MUTEX(i2o_block_mutex);
73static struct i2o_driver i2o_block_driver;
74
75/* global Block OSM request mempool */
76static struct i2o_block_mempool i2o_blk_req_pool;
77
78/* Block OSM class handling definition */
79static struct i2o_class_id i2o_block_class_id[] = {
80 {I2O_CLASS_RANDOM_BLOCK_STORAGE},
81 {I2O_CLASS_END}
82};
83
84/**
85 * i2o_block_device_free - free the memory of the I2O Block device
86 * @dev: I2O Block device, which should be cleaned up
87 *
88 * Frees the request queue, gendisk and the i2o_block_device structure.
89 */
90static void i2o_block_device_free(struct i2o_block_device *dev)
91{
92 blk_cleanup_queue(dev->gd->queue);
93
94 put_disk(dev->gd);
95
96 kfree(dev);
97};
98
99/**
100 * i2o_block_remove - remove the I2O Block device from the system again
101 * @dev: I2O Block device which should be removed
102 *
103 * Remove gendisk from system and free all allocated memory.
104 *
105 * Always returns 0.
106 */
107static int i2o_block_remove(struct device *dev)
108{
109 struct i2o_device *i2o_dev = to_i2o_device(dev);
110 struct i2o_block_device *i2o_blk_dev = dev_get_drvdata(dev);
111
112 osm_info("device removed (TID: %03x): %s\n", i2o_dev->lct_data.tid,
113 i2o_blk_dev->gd->disk_name);
114
115 i2o_event_register(i2o_dev, &i2o_block_driver, 0, 0);
116
117 del_gendisk(i2o_blk_dev->gd);
118
119 dev_set_drvdata(dev, NULL);
120
121 i2o_device_claim_release(i2o_dev);
122
123 i2o_block_device_free(i2o_blk_dev);
124
125 return 0;
126};
127
128/**
129 * i2o_block_device flush - Flush all dirty data of I2O device dev
130 * @dev: I2O device which should be flushed
131 *
132 * Flushes all dirty data on device dev.
133 *
134 * Returns 0 on success or negative error code on failure.
135 */
136static int i2o_block_device_flush(struct i2o_device *dev)
137{
138 struct i2o_message *msg;
139
140 msg = i2o_msg_get_wait(dev->iop, I2O_TIMEOUT_MESSAGE_GET);
141 if (IS_ERR(msg))
142 return PTR_ERR(msg);
143
144 msg->u.head[0] = cpu_to_le32(FIVE_WORD_MSG_SIZE | SGL_OFFSET_0);
145 msg->u.head[1] =
146 cpu_to_le32(I2O_CMD_BLOCK_CFLUSH << 24 | HOST_TID << 12 | dev->
147 lct_data.tid);
148 msg->body[0] = cpu_to_le32(60 << 16);
149 osm_debug("Flushing...\n");
150
151 return i2o_msg_post_wait(dev->iop, msg, 60);
152};
153
154/**
155 * i2o_block_device_mount - Mount (load) the media of device dev
156 * @dev: I2O device which should receive the mount request
157 * @media_id: Media Identifier
158 *
159 * Load a media into drive. Identifier should be set to -1, because the
160 * spec does not support any other value.
161 *
162 * Returns 0 on success or negative error code on failure.
163 */
164static int i2o_block_device_mount(struct i2o_device *dev, u32 media_id)
165{
166 struct i2o_message *msg;
167
168 msg = i2o_msg_get_wait(dev->iop, I2O_TIMEOUT_MESSAGE_GET);
169 if (IS_ERR(msg))
170 return PTR_ERR(msg);
171
172 msg->u.head[0] = cpu_to_le32(FIVE_WORD_MSG_SIZE | SGL_OFFSET_0);
173 msg->u.head[1] =
174 cpu_to_le32(I2O_CMD_BLOCK_MMOUNT << 24 | HOST_TID << 12 | dev->
175 lct_data.tid);
176 msg->body[0] = cpu_to_le32(-1);
177 msg->body[1] = cpu_to_le32(0x00000000);
178 osm_debug("Mounting...\n");
179
180 return i2o_msg_post_wait(dev->iop, msg, 2);
181};
182
183/**
184 * i2o_block_device_lock - Locks the media of device dev
185 * @dev: I2O device which should receive the lock request
186 * @media_id: Media Identifier
187 *
188 * Lock media of device dev to prevent removal. The media identifier
189 * should be set to -1, because the spec does not support any other value.
190 *
191 * Returns 0 on success or negative error code on failure.
192 */
193static int i2o_block_device_lock(struct i2o_device *dev, u32 media_id)
194{
195 struct i2o_message *msg;
196
197 msg = i2o_msg_get_wait(dev->iop, I2O_TIMEOUT_MESSAGE_GET);
198 if (IS_ERR(msg))
199 return PTR_ERR(msg);
200
201 msg->u.head[0] = cpu_to_le32(FIVE_WORD_MSG_SIZE | SGL_OFFSET_0);
202 msg->u.head[1] =
203 cpu_to_le32(I2O_CMD_BLOCK_MLOCK << 24 | HOST_TID << 12 | dev->
204 lct_data.tid);
205 msg->body[0] = cpu_to_le32(-1);
206 osm_debug("Locking...\n");
207
208 return i2o_msg_post_wait(dev->iop, msg, 2);
209};
210
211/**
212 * i2o_block_device_unlock - Unlocks the media of device dev
213 * @dev: I2O device which should receive the unlocked request
214 * @media_id: Media Identifier
215 *
216 * Unlocks the media in device dev. The media identifier should be set to
217 * -1, because the spec does not support any other value.
218 *
219 * Returns 0 on success or negative error code on failure.
220 */
221static int i2o_block_device_unlock(struct i2o_device *dev, u32 media_id)
222{
223 struct i2o_message *msg;
224
225 msg = i2o_msg_get_wait(dev->iop, I2O_TIMEOUT_MESSAGE_GET);
226 if (IS_ERR(msg))
227 return PTR_ERR(msg);
228
229 msg->u.head[0] = cpu_to_le32(FIVE_WORD_MSG_SIZE | SGL_OFFSET_0);
230 msg->u.head[1] =
231 cpu_to_le32(I2O_CMD_BLOCK_MUNLOCK << 24 | HOST_TID << 12 | dev->
232 lct_data.tid);
233 msg->body[0] = cpu_to_le32(media_id);
234 osm_debug("Unlocking...\n");
235
236 return i2o_msg_post_wait(dev->iop, msg, 2);
237};
238
239/**
240 * i2o_block_device_power - Power management for device dev
241 * @dev: I2O device which should receive the power management request
242 * @op: Operation to send
243 *
244 * Send a power management request to the device dev.
245 *
246 * Returns 0 on success or negative error code on failure.
247 */
248static int i2o_block_device_power(struct i2o_block_device *dev, u8 op)
249{
250 struct i2o_device *i2o_dev = dev->i2o_dev;
251 struct i2o_controller *c = i2o_dev->iop;
252 struct i2o_message *msg;
253 int rc;
254
255 msg = i2o_msg_get_wait(c, I2O_TIMEOUT_MESSAGE_GET);
256 if (IS_ERR(msg))
257 return PTR_ERR(msg);
258
259 msg->u.head[0] = cpu_to_le32(FOUR_WORD_MSG_SIZE | SGL_OFFSET_0);
260 msg->u.head[1] =
261 cpu_to_le32(I2O_CMD_BLOCK_POWER << 24 | HOST_TID << 12 | i2o_dev->
262 lct_data.tid);
263 msg->body[0] = cpu_to_le32(op << 24);
264 osm_debug("Power...\n");
265
266 rc = i2o_msg_post_wait(c, msg, 60);
267 if (!rc)
268 dev->power = op;
269
270 return rc;
271};
272
273/**
274 * i2o_block_request_alloc - Allocate an I2O block request struct
275 *
276 * Allocates an I2O block request struct and initialize the list.
277 *
278 * Returns a i2o_block_request pointer on success or negative error code
279 * on failure.
280 */
281static inline struct i2o_block_request *i2o_block_request_alloc(void)
282{
283 struct i2o_block_request *ireq;
284
285 ireq = mempool_alloc(i2o_blk_req_pool.pool, GFP_ATOMIC);
286 if (!ireq)
287 return ERR_PTR(-ENOMEM);
288
289 INIT_LIST_HEAD(&ireq->queue);
290 sg_init_table(ireq->sg_table, I2O_MAX_PHYS_SEGMENTS);
291
292 return ireq;
293};
294
295/**
296 * i2o_block_request_free - Frees a I2O block request
297 * @ireq: I2O block request which should be freed
298 *
299 * Frees the allocated memory (give it back to the request mempool).
300 */
301static inline void i2o_block_request_free(struct i2o_block_request *ireq)
302{
303 mempool_free(ireq, i2o_blk_req_pool.pool);
304};
305
306/**
307 * i2o_block_sglist_alloc - Allocate the SG list and map it
308 * @c: I2O controller to which the request belongs
309 * @ireq: I2O block request
310 * @mptr: message body pointer
311 *
312 * Builds the SG list and map it to be accessible by the controller.
313 *
314 * Returns 0 on failure or 1 on success.
315 */
316static inline int i2o_block_sglist_alloc(struct i2o_controller *c,
317 struct i2o_block_request *ireq,
318 u32 ** mptr)
319{
320 int nents;
321 enum dma_data_direction direction;
322
323 ireq->dev = &c->pdev->dev;
324 nents = blk_rq_map_sg(ireq->req->q, ireq->req, ireq->sg_table);
325
326 if (rq_data_dir(ireq->req) == READ)
327 direction = PCI_DMA_FROMDEVICE;
328 else
329 direction = PCI_DMA_TODEVICE;
330
331 ireq->sg_nents = nents;
332
333 return i2o_dma_map_sg(c, ireq->sg_table, nents, direction, mptr);
334};
335
336/**
337 * i2o_block_sglist_free - Frees the SG list
338 * @ireq: I2O block request from which the SG should be freed
339 *
340 * Frees the SG list from the I2O block request.
341 */
342static inline void i2o_block_sglist_free(struct i2o_block_request *ireq)
343{
344 enum dma_data_direction direction;
345
346 if (rq_data_dir(ireq->req) == READ)
347 direction = PCI_DMA_FROMDEVICE;
348 else
349 direction = PCI_DMA_TODEVICE;
350
351 dma_unmap_sg(ireq->dev, ireq->sg_table, ireq->sg_nents, direction);
352};
353
354/**
355 * i2o_block_prep_req_fn - Allocates I2O block device specific struct
356 * @q: request queue for the request
357 * @req: the request to prepare
358 *
359 * Allocate the necessary i2o_block_request struct and connect it to
360 * the request. This is needed that we not lose the SG list later on.
361 *
362 * Returns BLKPREP_OK on success or BLKPREP_DEFER on failure.
363 */
364static int i2o_block_prep_req_fn(struct request_queue *q, struct request *req)
365{
366 struct i2o_block_device *i2o_blk_dev = q->queuedata;
367 struct i2o_block_request *ireq;
368
369 if (unlikely(!i2o_blk_dev)) {
370 osm_err("block device already removed\n");
371 return BLKPREP_KILL;
372 }
373
374 /* connect the i2o_block_request to the request */
375 if (!req->special) {
376 ireq = i2o_block_request_alloc();
377 if (IS_ERR(ireq)) {
378 osm_debug("unable to allocate i2o_block_request!\n");
379 return BLKPREP_DEFER;
380 }
381
382 ireq->i2o_blk_dev = i2o_blk_dev;
383 req->special = ireq;
384 ireq->req = req;
385 }
386 /* do not come back here */
387 req->cmd_flags |= REQ_DONTPREP;
388
389 return BLKPREP_OK;
390};
391
392/**
393 * i2o_block_delayed_request_fn - delayed request queue function
394 * @work: the delayed request with the queue to start
395 *
396 * If the request queue is stopped for a disk, and there is no open
397 * request, a new event is created, which calls this function to start
398 * the queue after I2O_BLOCK_REQUEST_TIME. Otherwise the queue will never
399 * be started again.
400 */
401static void i2o_block_delayed_request_fn(struct work_struct *work)
402{
403 struct i2o_block_delayed_request *dreq =
404 container_of(work, struct i2o_block_delayed_request,
405 work.work);
406 struct request_queue *q = dreq->queue;
407 unsigned long flags;
408
409 spin_lock_irqsave(q->queue_lock, flags);
410 blk_start_queue(q);
411 spin_unlock_irqrestore(q->queue_lock, flags);
412 kfree(dreq);
413};
414
415/**
416 * i2o_block_end_request - Post-processing of completed commands
417 * @req: request which should be completed
418 * @error: 0 for success, < 0 for error
419 * @nr_bytes: number of bytes to complete
420 *
421 * Mark the request as complete. The lock must not be held when entering.
422 *
423 */
424static void i2o_block_end_request(struct request *req, int error,
425 int nr_bytes)
426{
427 struct i2o_block_request *ireq = req->special;
428 struct i2o_block_device *dev = ireq->i2o_blk_dev;
429 struct request_queue *q = req->q;
430 unsigned long flags;
431
432 if (blk_end_request(req, error, nr_bytes))
433 if (error)
434 blk_end_request_all(req, -EIO);
435
436 spin_lock_irqsave(q->queue_lock, flags);
437
438 if (likely(dev)) {
439 dev->open_queue_depth--;
440 list_del(&ireq->queue);
441 }
442
443 blk_start_queue(q);
444
445 spin_unlock_irqrestore(q->queue_lock, flags);
446
447 i2o_block_sglist_free(ireq);
448 i2o_block_request_free(ireq);
449};
450
451/**
452 * i2o_block_reply - Block OSM reply handler.
453 * @c: I2O controller from which the message arrives
454 * @m: message id of reply
455 * @msg: the actual I2O message reply
456 *
457 * This function gets all the message replies.
458 *
459 */
460static int i2o_block_reply(struct i2o_controller *c, u32 m,
461 struct i2o_message *msg)
462{
463 struct request *req;
464 int error = 0;
465
466 req = i2o_cntxt_list_get(c, le32_to_cpu(msg->u.s.tcntxt));
467 if (unlikely(!req)) {
468 osm_err("NULL reply received!\n");
469 return -1;
470 }
471
472 /*
473 * Lets see what is cooking. We stuffed the
474 * request in the context.
475 */
476
477 if ((le32_to_cpu(msg->body[0]) >> 24) != 0) {
478 u32 status = le32_to_cpu(msg->body[0]);
479 /*
480 * Device not ready means two things. One is that the
481 * the thing went offline (but not a removal media)
482 *
483 * The second is that you have a SuperTrak 100 and the
484 * firmware got constipated. Unlike standard i2o card
485 * setups the supertrak returns an error rather than
486 * blocking for the timeout in these cases.
487 *
488 * Don't stick a supertrak100 into cache aggressive modes
489 */
490
491 osm_err("TID %03x error status: 0x%02x, detailed status: "
492 "0x%04x\n", (le32_to_cpu(msg->u.head[1]) >> 12 & 0xfff),
493 status >> 24, status & 0xffff);
494
495 req->errors++;
496
497 error = -EIO;
498 }
499
500 i2o_block_end_request(req, error, le32_to_cpu(msg->body[1]));
501
502 return 1;
503};
504
505static void i2o_block_event(struct work_struct *work)
506{
507 struct i2o_event *evt = container_of(work, struct i2o_event, work);
508 osm_debug("event received\n");
509 kfree(evt);
510};
511
512/*
513 * SCSI-CAM for ioctl geometry mapping
514 * Duplicated with SCSI - this should be moved into somewhere common
515 * perhaps genhd ?
516 *
517 * LBA -> CHS mapping table taken from:
518 *
519 * "Incorporating the I2O Architecture into BIOS for Intel Architecture
520 * Platforms"
521 *
522 * This is an I2O document that is only available to I2O members,
523 * not developers.
524 *
525 * From my understanding, this is how all the I2O cards do this
526 *
527 * Disk Size | Sectors | Heads | Cylinders
528 * ---------------+---------+-------+-------------------
529 * 1 < X <= 528M | 63 | 16 | X/(63 * 16 * 512)
530 * 528M < X <= 1G | 63 | 32 | X/(63 * 32 * 512)
531 * 1 < X <528M | 63 | 16 | X/(63 * 16 * 512)
532 * 1 < X <528M | 63 | 16 | X/(63 * 16 * 512)
533 *
534 */
535#define BLOCK_SIZE_528M 1081344
536#define BLOCK_SIZE_1G 2097152
537#define BLOCK_SIZE_21G 4403200
538#define BLOCK_SIZE_42G 8806400
539#define BLOCK_SIZE_84G 17612800
540
541static void i2o_block_biosparam(unsigned long capacity, unsigned short *cyls,
542 unsigned char *hds, unsigned char *secs)
543{
544 unsigned long heads, sectors, cylinders;
545
546 sectors = 63L; /* Maximize sectors per track */
547 if (capacity <= BLOCK_SIZE_528M)
548 heads = 16;
549 else if (capacity <= BLOCK_SIZE_1G)
550 heads = 32;
551 else if (capacity <= BLOCK_SIZE_21G)
552 heads = 64;
553 else if (capacity <= BLOCK_SIZE_42G)
554 heads = 128;
555 else
556 heads = 255;
557
558 cylinders = (unsigned long)capacity / (heads * sectors);
559
560 *cyls = (unsigned short)cylinders; /* Stuff return values */
561 *secs = (unsigned char)sectors;
562 *hds = (unsigned char)heads;
563}
564
565/**
566 * i2o_block_open - Open the block device
567 * @bdev: block device being opened
568 * @mode: file open mode
569 *
570 * Power up the device, mount and lock the media. This function is called,
571 * if the block device is opened for access.
572 *
573 * Returns 0 on success or negative error code on failure.
574 */
575static int i2o_block_open(struct block_device *bdev, fmode_t mode)
576{
577 struct i2o_block_device *dev = bdev->bd_disk->private_data;
578
579 if (!dev->i2o_dev)
580 return -ENODEV;
581
582 mutex_lock(&i2o_block_mutex);
583 if (dev->power > 0x1f)
584 i2o_block_device_power(dev, 0x02);
585
586 i2o_block_device_mount(dev->i2o_dev, -1);
587
588 i2o_block_device_lock(dev->i2o_dev, -1);
589
590 osm_debug("Ready.\n");
591 mutex_unlock(&i2o_block_mutex);
592
593 return 0;
594};
595
596/**
597 * i2o_block_release - Release the I2O block device
598 * @disk: gendisk device being released
599 * @mode: file open mode
600 *
601 * Unlock and unmount the media, and power down the device. Gets called if
602 * the block device is closed.
603 *
604 * Returns 0 on success or negative error code on failure.
605 */
606static int i2o_block_release(struct gendisk *disk, fmode_t mode)
607{
608 struct i2o_block_device *dev = disk->private_data;
609 u8 operation;
610
611 /*
612 * This is to deail with the case of an application
613 * opening a device and then the device disappears while
614 * it's in use, and then the application tries to release
615 * it. ex: Unmounting a deleted RAID volume at reboot.
616 * If we send messages, it will just cause FAILs since
617 * the TID no longer exists.
618 */
619 if (!dev->i2o_dev)
620 return 0;
621
622 mutex_lock(&i2o_block_mutex);
623 i2o_block_device_flush(dev->i2o_dev);
624
625 i2o_block_device_unlock(dev->i2o_dev, -1);
626
627 if (dev->flags & (1 << 3 | 1 << 4)) /* Removable */
628 operation = 0x21;
629 else
630 operation = 0x24;
631
632 i2o_block_device_power(dev, operation);
633 mutex_unlock(&i2o_block_mutex);
634
635 return 0;
636}
637
638static int i2o_block_getgeo(struct block_device *bdev, struct hd_geometry *geo)
639{
640 i2o_block_biosparam(get_capacity(bdev->bd_disk),
641 &geo->cylinders, &geo->heads, &geo->sectors);
642 return 0;
643}
644
645/**
646 * i2o_block_ioctl - Issue device specific ioctl calls.
647 * @bdev: block device being opened
648 * @mode: file open mode
649 * @cmd: ioctl command
650 * @arg: arg
651 *
652 * Handles ioctl request for the block device.
653 *
654 * Return 0 on success or negative error on failure.
655 */
656static int i2o_block_ioctl(struct block_device *bdev, fmode_t mode,
657 unsigned int cmd, unsigned long arg)
658{
659 struct gendisk *disk = bdev->bd_disk;
660 struct i2o_block_device *dev = disk->private_data;
661 int ret = -ENOTTY;
662
663 /* Anyone capable of this syscall can do *real bad* things */
664
665 if (!capable(CAP_SYS_ADMIN))
666 return -EPERM;
667
668 mutex_lock(&i2o_block_mutex);
669 switch (cmd) {
670 case BLKI2OGRSTRAT:
671 ret = put_user(dev->rcache, (int __user *)arg);
672 break;
673 case BLKI2OGWSTRAT:
674 ret = put_user(dev->wcache, (int __user *)arg);
675 break;
676 case BLKI2OSRSTRAT:
677 ret = -EINVAL;
678 if (arg < 0 || arg > CACHE_SMARTFETCH)
679 break;
680 dev->rcache = arg;
681 ret = 0;
682 break;
683 case BLKI2OSWSTRAT:
684 ret = -EINVAL;
685 if (arg != 0
686 && (arg < CACHE_WRITETHROUGH || arg > CACHE_SMARTBACK))
687 break;
688 dev->wcache = arg;
689 ret = 0;
690 break;
691 }
692 mutex_unlock(&i2o_block_mutex);
693
694 return ret;
695};
696
697/**
698 * i2o_block_check_events - Have we seen a media change?
699 * @disk: gendisk which should be verified
700 * @clearing: events being cleared
701 *
702 * Verifies if the media has changed.
703 *
704 * Returns 1 if the media was changed or 0 otherwise.
705 */
706static unsigned int i2o_block_check_events(struct gendisk *disk,
707 unsigned int clearing)
708{
709 struct i2o_block_device *p = disk->private_data;
710
711 if (p->media_change_flag) {
712 p->media_change_flag = 0;
713 return DISK_EVENT_MEDIA_CHANGE;
714 }
715 return 0;
716}
717
718/**
719 * i2o_block_transfer - Transfer a request to/from the I2O controller
720 * @req: the request which should be transferred
721 *
722 * This function converts the request into a I2O message. The necessary
723 * DMA buffers are allocated and after everything is setup post the message
724 * to the I2O controller. No cleanup is done by this function. It is done
725 * on the interrupt side when the reply arrives.
726 *
727 * Return 0 on success or negative error code on failure.
728 */
729static int i2o_block_transfer(struct request *req)
730{
731 struct i2o_block_device *dev = req->rq_disk->private_data;
732 struct i2o_controller *c;
733 u32 tid;
734 struct i2o_message *msg;
735 u32 *mptr;
736 struct i2o_block_request *ireq = req->special;
737 u32 tcntxt;
738 u32 sgl_offset = SGL_OFFSET_8;
739 u32 ctl_flags = 0x00000000;
740 int rc;
741 u32 cmd;
742
743 if (unlikely(!dev->i2o_dev)) {
744 osm_err("transfer to removed drive\n");
745 rc = -ENODEV;
746 goto exit;
747 }
748
749 tid = dev->i2o_dev->lct_data.tid;
750 c = dev->i2o_dev->iop;
751
752 msg = i2o_msg_get(c);
753 if (IS_ERR(msg)) {
754 rc = PTR_ERR(msg);
755 goto exit;
756 }
757
758 tcntxt = i2o_cntxt_list_add(c, req);
759 if (!tcntxt) {
760 rc = -ENOMEM;
761 goto nop_msg;
762 }
763
764 msg->u.s.icntxt = cpu_to_le32(i2o_block_driver.context);
765 msg->u.s.tcntxt = cpu_to_le32(tcntxt);
766
767 mptr = &msg->body[0];
768
769 if (rq_data_dir(req) == READ) {
770 cmd = I2O_CMD_BLOCK_READ << 24;
771
772 switch (dev->rcache) {
773 case CACHE_PREFETCH:
774 ctl_flags = 0x201F0008;
775 break;
776
777 case CACHE_SMARTFETCH:
778 if (blk_rq_sectors(req) > 16)
779 ctl_flags = 0x201F0008;
780 else
781 ctl_flags = 0x001F0000;
782 break;
783
784 default:
785 break;
786 }
787 } else {
788 cmd = I2O_CMD_BLOCK_WRITE << 24;
789
790 switch (dev->wcache) {
791 case CACHE_WRITETHROUGH:
792 ctl_flags = 0x001F0008;
793 break;
794 case CACHE_WRITEBACK:
795 ctl_flags = 0x001F0010;
796 break;
797 case CACHE_SMARTBACK:
798 if (blk_rq_sectors(req) > 16)
799 ctl_flags = 0x001F0004;
800 else
801 ctl_flags = 0x001F0010;
802 break;
803 case CACHE_SMARTTHROUGH:
804 if (blk_rq_sectors(req) > 16)
805 ctl_flags = 0x001F0004;
806 else
807 ctl_flags = 0x001F0010;
808 default:
809 break;
810 }
811 }
812
813#ifdef CONFIG_I2O_EXT_ADAPTEC
814 if (c->adaptec) {
815 u8 cmd[10];
816 u32 scsi_flags;
817 u16 hwsec;
818
819 hwsec = queue_logical_block_size(req->q) >> KERNEL_SECTOR_SHIFT;
820 memset(cmd, 0, 10);
821
822 sgl_offset = SGL_OFFSET_12;
823
824 msg->u.head[1] =
825 cpu_to_le32(I2O_CMD_PRIVATE << 24 | HOST_TID << 12 | tid);
826
827 *mptr++ = cpu_to_le32(I2O_VENDOR_DPT << 16 | I2O_CMD_SCSI_EXEC);
828 *mptr++ = cpu_to_le32(tid);
829
830 /*
831 * ENABLE_DISCONNECT
832 * SIMPLE_TAG
833 * RETURN_SENSE_DATA_IN_REPLY_MESSAGE_FRAME
834 */
835 if (rq_data_dir(req) == READ) {
836 cmd[0] = READ_10;
837 scsi_flags = 0x60a0000a;
838 } else {
839 cmd[0] = WRITE_10;
840 scsi_flags = 0xa0a0000a;
841 }
842
843 *mptr++ = cpu_to_le32(scsi_flags);
844
845 *((u32 *) & cmd[2]) = cpu_to_be32(blk_rq_pos(req) * hwsec);
846 *((u16 *) & cmd[7]) = cpu_to_be16(blk_rq_sectors(req) * hwsec);
847
848 memcpy(mptr, cmd, 10);
849 mptr += 4;
850 *mptr++ = cpu_to_le32(blk_rq_bytes(req));
851 } else
852#endif
853 {
854 msg->u.head[1] = cpu_to_le32(cmd | HOST_TID << 12 | tid);
855 *mptr++ = cpu_to_le32(ctl_flags);
856 *mptr++ = cpu_to_le32(blk_rq_bytes(req));
857 *mptr++ =
858 cpu_to_le32((u32) (blk_rq_pos(req) << KERNEL_SECTOR_SHIFT));
859 *mptr++ =
860 cpu_to_le32(blk_rq_pos(req) >> (32 - KERNEL_SECTOR_SHIFT));
861 }
862
863 if (!i2o_block_sglist_alloc(c, ireq, &mptr)) {
864 rc = -ENOMEM;
865 goto context_remove;
866 }
867
868 msg->u.head[0] =
869 cpu_to_le32(I2O_MESSAGE_SIZE(mptr - &msg->u.head[0]) | sgl_offset);
870
871 list_add_tail(&ireq->queue, &dev->open_queue);
872 dev->open_queue_depth++;
873
874 i2o_msg_post(c, msg);
875
876 return 0;
877
878 context_remove:
879 i2o_cntxt_list_remove(c, req);
880
881 nop_msg:
882 i2o_msg_nop(c, msg);
883
884 exit:
885 return rc;
886};
887
888/**
889 * i2o_block_request_fn - request queue handling function
890 * @q: request queue from which the request could be fetched
891 *
892 * Takes the next request from the queue, transfers it and if no error
893 * occurs dequeue it from the queue. On arrival of the reply the message
894 * will be processed further. If an error occurs requeue the request.
895 */
896static void i2o_block_request_fn(struct request_queue *q)
897{
898 struct request *req;
899
900 while ((req = blk_peek_request(q)) != NULL) {
901 if (req->cmd_type == REQ_TYPE_FS) {
902 struct i2o_block_delayed_request *dreq;
903 struct i2o_block_request *ireq = req->special;
904 unsigned int queue_depth;
905
906 queue_depth = ireq->i2o_blk_dev->open_queue_depth;
907
908 if (queue_depth < I2O_BLOCK_MAX_OPEN_REQUESTS) {
909 if (!i2o_block_transfer(req)) {
910 blk_start_request(req);
911 continue;
912 } else
913 osm_info("transfer error\n");
914 }
915
916 if (queue_depth)
917 break;
918
919 /* stop the queue and retry later */
920 dreq = kmalloc(sizeof(*dreq), GFP_ATOMIC);
921 if (!dreq)
922 continue;
923
924 dreq->queue = q;
925 INIT_DELAYED_WORK(&dreq->work,
926 i2o_block_delayed_request_fn);
927
928 if (!queue_delayed_work(i2o_block_driver.event_queue,
929 &dreq->work,
930 I2O_BLOCK_RETRY_TIME))
931 kfree(dreq);
932 else {
933 blk_stop_queue(q);
934 break;
935 }
936 } else {
937 blk_start_request(req);
938 __blk_end_request_all(req, -EIO);
939 }
940 }
941};
942
943/* I2O Block device operations definition */
944static const struct block_device_operations i2o_block_fops = {
945 .owner = THIS_MODULE,
946 .open = i2o_block_open,
947 .release = i2o_block_release,
948 .ioctl = i2o_block_ioctl,
949 .compat_ioctl = i2o_block_ioctl,
950 .getgeo = i2o_block_getgeo,
951 .check_events = i2o_block_check_events,
952};
953
954/**
955 * i2o_block_device_alloc - Allocate memory for a I2O Block device
956 *
957 * Allocate memory for the i2o_block_device struct, gendisk and request
958 * queue and initialize them as far as no additional information is needed.
959 *
960 * Returns a pointer to the allocated I2O Block device on success or a
961 * negative error code on failure.
962 */
963static struct i2o_block_device *i2o_block_device_alloc(void)
964{
965 struct i2o_block_device *dev;
966 struct gendisk *gd;
967 struct request_queue *queue;
968 int rc;
969
970 dev = kzalloc(sizeof(*dev), GFP_KERNEL);
971 if (!dev) {
972 osm_err("Insufficient memory to allocate I2O Block disk.\n");
973 rc = -ENOMEM;
974 goto exit;
975 }
976
977 INIT_LIST_HEAD(&dev->open_queue);
978 spin_lock_init(&dev->lock);
979 dev->rcache = CACHE_PREFETCH;
980 dev->wcache = CACHE_WRITEBACK;
981
982 /* allocate a gendisk with 16 partitions */
983 gd = alloc_disk(16);
984 if (!gd) {
985 osm_err("Insufficient memory to allocate gendisk.\n");
986 rc = -ENOMEM;
987 goto cleanup_dev;
988 }
989
990 /* initialize the request queue */
991 queue = blk_init_queue(i2o_block_request_fn, &dev->lock);
992 if (!queue) {
993 osm_err("Insufficient memory to allocate request queue.\n");
994 rc = -ENOMEM;
995 goto cleanup_queue;
996 }
997
998 blk_queue_prep_rq(queue, i2o_block_prep_req_fn);
999
1000 gd->major = I2O_MAJOR;
1001 gd->queue = queue;
1002 gd->fops = &i2o_block_fops;
1003 gd->private_data = dev;
1004
1005 dev->gd = gd;
1006
1007 return dev;
1008
1009 cleanup_queue:
1010 put_disk(gd);
1011
1012 cleanup_dev:
1013 kfree(dev);
1014
1015 exit:
1016 return ERR_PTR(rc);
1017};
1018
1019/**
1020 * i2o_block_probe - verify if dev is a I2O Block device and install it
1021 * @dev: device to verify if it is a I2O Block device
1022 *
1023 * We only verify if the user_tid of the device is 0xfff and then install
1024 * the device. Otherwise it is used by some other device (e. g. RAID).
1025 *
1026 * Returns 0 on success or negative error code on failure.
1027 */
1028static int i2o_block_probe(struct device *dev)
1029{
1030 struct i2o_device *i2o_dev = to_i2o_device(dev);
1031 struct i2o_controller *c = i2o_dev->iop;
1032 struct i2o_block_device *i2o_blk_dev;
1033 struct gendisk *gd;
1034 struct request_queue *queue;
1035 static int unit = 0;
1036 int rc;
1037 u64 size;
1038 u32 blocksize;
1039 u16 body_size = 4;
1040 u16 power;
1041 unsigned short max_sectors;
1042
1043#ifdef CONFIG_I2O_EXT_ADAPTEC
1044 if (c->adaptec)
1045 body_size = 8;
1046#endif
1047
1048 if (c->limit_sectors)
1049 max_sectors = I2O_MAX_SECTORS_LIMITED;
1050 else
1051 max_sectors = I2O_MAX_SECTORS;
1052
1053 /* skip devices which are used by IOP */
1054 if (i2o_dev->lct_data.user_tid != 0xfff) {
1055 osm_debug("skipping used device %03x\n", i2o_dev->lct_data.tid);
1056 return -ENODEV;
1057 }
1058
1059 if (i2o_device_claim(i2o_dev)) {
1060 osm_warn("Unable to claim device. Installation aborted\n");
1061 rc = -EFAULT;
1062 goto exit;
1063 }
1064
1065 i2o_blk_dev = i2o_block_device_alloc();
1066 if (IS_ERR(i2o_blk_dev)) {
1067 osm_err("could not alloc a new I2O block device");
1068 rc = PTR_ERR(i2o_blk_dev);
1069 goto claim_release;
1070 }
1071
1072 i2o_blk_dev->i2o_dev = i2o_dev;
1073 dev_set_drvdata(dev, i2o_blk_dev);
1074
1075 /* setup gendisk */
1076 gd = i2o_blk_dev->gd;
1077 gd->first_minor = unit << 4;
1078 sprintf(gd->disk_name, "i2o/hd%c", 'a' + unit);
1079 gd->driverfs_dev = &i2o_dev->device;
1080
1081 /* setup request queue */
1082 queue = gd->queue;
1083 queue->queuedata = i2o_blk_dev;
1084
1085 blk_queue_max_hw_sectors(queue, max_sectors);
1086 blk_queue_max_segments(queue, i2o_sg_tablesize(c, body_size));
1087
1088 osm_debug("max sectors = %d\n", queue->max_sectors);
1089 osm_debug("phys segments = %d\n", queue->max_phys_segments);
1090 osm_debug("max hw segments = %d\n", queue->max_hw_segments);
1091
1092 /*
1093 * Ask for the current media data. If that isn't supported
1094 * then we ask for the device capacity data
1095 */
1096 if (!i2o_parm_field_get(i2o_dev, 0x0004, 1, &blocksize, 4) ||
1097 !i2o_parm_field_get(i2o_dev, 0x0000, 3, &blocksize, 4)) {
1098 blk_queue_logical_block_size(queue, le32_to_cpu(blocksize));
1099 } else
1100 osm_warn("unable to get blocksize of %s\n", gd->disk_name);
1101
1102 if (!i2o_parm_field_get(i2o_dev, 0x0004, 0, &size, 8) ||
1103 !i2o_parm_field_get(i2o_dev, 0x0000, 4, &size, 8)) {
1104 set_capacity(gd, le64_to_cpu(size) >> KERNEL_SECTOR_SHIFT);
1105 } else
1106 osm_warn("could not get size of %s\n", gd->disk_name);
1107
1108 if (!i2o_parm_field_get(i2o_dev, 0x0000, 2, &power, 2))
1109 i2o_blk_dev->power = power;
1110
1111 i2o_event_register(i2o_dev, &i2o_block_driver, 0, 0xffffffff);
1112
1113 add_disk(gd);
1114
1115 unit++;
1116
1117 osm_info("device added (TID: %03x): %s\n", i2o_dev->lct_data.tid,
1118 i2o_blk_dev->gd->disk_name);
1119
1120 return 0;
1121
1122 claim_release:
1123 i2o_device_claim_release(i2o_dev);
1124
1125 exit:
1126 return rc;
1127};
1128
1129/* Block OSM driver struct */
1130static struct i2o_driver i2o_block_driver = {
1131 .name = OSM_NAME,
1132 .event = i2o_block_event,
1133 .reply = i2o_block_reply,
1134 .classes = i2o_block_class_id,
1135 .driver = {
1136 .probe = i2o_block_probe,
1137 .remove = i2o_block_remove,
1138 },
1139};
1140
1141/**
1142 * i2o_block_init - Block OSM initialization function
1143 *
1144 * Allocate the slab and mempool for request structs, registers i2o_block
1145 * block device and finally register the Block OSM in the I2O core.
1146 *
1147 * Returns 0 on success or negative error code on failure.
1148 */
1149static int __init i2o_block_init(void)
1150{
1151 int rc;
1152 int size;
1153
1154 printk(KERN_INFO OSM_DESCRIPTION " v" OSM_VERSION "\n");
1155
1156 /* Allocate request mempool and slab */
1157 size = sizeof(struct i2o_block_request);
1158 i2o_blk_req_pool.slab = kmem_cache_create("i2o_block_req", size, 0,
1159 SLAB_HWCACHE_ALIGN, NULL);
1160 if (!i2o_blk_req_pool.slab) {
1161 osm_err("can't init request slab\n");
1162 rc = -ENOMEM;
1163 goto exit;
1164 }
1165
1166 i2o_blk_req_pool.pool =
1167 mempool_create_slab_pool(I2O_BLOCK_REQ_MEMPOOL_SIZE,
1168 i2o_blk_req_pool.slab);
1169 if (!i2o_blk_req_pool.pool) {
1170 osm_err("can't init request mempool\n");
1171 rc = -ENOMEM;
1172 goto free_slab;
1173 }
1174
1175 /* Register the block device interfaces */
1176 rc = register_blkdev(I2O_MAJOR, "i2o_block");
1177 if (rc) {
1178 osm_err("unable to register block device\n");
1179 goto free_mempool;
1180 }
1181#ifdef MODULE
1182 osm_info("registered device at major %d\n", I2O_MAJOR);
1183#endif
1184
1185 /* Register Block OSM into I2O core */
1186 rc = i2o_driver_register(&i2o_block_driver);
1187 if (rc) {
1188 osm_err("Could not register Block driver\n");
1189 goto unregister_blkdev;
1190 }
1191
1192 return 0;
1193
1194 unregister_blkdev:
1195 unregister_blkdev(I2O_MAJOR, "i2o_block");
1196
1197 free_mempool:
1198 mempool_destroy(i2o_blk_req_pool.pool);
1199
1200 free_slab:
1201 kmem_cache_destroy(i2o_blk_req_pool.slab);
1202
1203 exit:
1204 return rc;
1205};
1206
1207/**
1208 * i2o_block_exit - Block OSM exit function
1209 *
1210 * Unregisters Block OSM from I2O core, unregisters i2o_block block device
1211 * and frees the mempool and slab.
1212 */
1213static void __exit i2o_block_exit(void)
1214{
1215 /* Unregister I2O Block OSM from I2O core */
1216 i2o_driver_unregister(&i2o_block_driver);
1217
1218 /* Unregister block device */
1219 unregister_blkdev(I2O_MAJOR, "i2o_block");
1220
1221 /* Free request mempool and slab */
1222 mempool_destroy(i2o_blk_req_pool.pool);
1223 kmem_cache_destroy(i2o_blk_req_pool.slab);
1224};
1225
1226MODULE_AUTHOR("Red Hat");
1227MODULE_LICENSE("GPL");
1228MODULE_DESCRIPTION(OSM_DESCRIPTION);
1229MODULE_VERSION(OSM_VERSION);
1230
1231module_init(i2o_block_init);
1232module_exit(i2o_block_exit);