1b2edd2fdSRoman Zippel /*
2b2edd2fdSRoman Zippel * ARAnyM block device driver
3b2edd2fdSRoman Zippel *
4b2edd2fdSRoman Zippel * This file is subject to the terms and conditions of the GNU General Public
5b2edd2fdSRoman Zippel * License. See the file COPYING in the main directory of this archive
6b2edd2fdSRoman Zippel * for more details.
7b2edd2fdSRoman Zippel */
8b2edd2fdSRoman Zippel
9b2edd2fdSRoman Zippel #include <linux/module.h>
10b2edd2fdSRoman Zippel #include <linux/moduleparam.h>
11b2edd2fdSRoman Zippel #include <linux/init.h>
12b2edd2fdSRoman Zippel
13b2edd2fdSRoman Zippel #include <linux/kernel.h>
14b2edd2fdSRoman Zippel #include <linux/errno.h>
15b2edd2fdSRoman Zippel #include <linux/types.h>
16b2edd2fdSRoman Zippel #include <linux/blkdev.h>
17b2edd2fdSRoman Zippel #include <linux/hdreg.h>
18b2edd2fdSRoman Zippel #include <linux/slab.h>
19b2edd2fdSRoman Zippel
20b2edd2fdSRoman Zippel #include <asm/natfeat.h>
21b2edd2fdSRoman Zippel
22b2edd2fdSRoman Zippel static long nfhd_id;
23b2edd2fdSRoman Zippel
24b2edd2fdSRoman Zippel enum {
25b2edd2fdSRoman Zippel /* emulation entry points */
26b2edd2fdSRoman Zippel NFHD_READ_WRITE = 10,
27b2edd2fdSRoman Zippel NFHD_GET_CAPACITY = 14,
28b2edd2fdSRoman Zippel
29b2edd2fdSRoman Zippel /* skip ACSI devices */
30b2edd2fdSRoman Zippel NFHD_DEV_OFFSET = 8,
31b2edd2fdSRoman Zippel };
32b2edd2fdSRoman Zippel
nfhd_read_write(u32 major,u32 minor,u32 rwflag,u32 recno,u32 count,u32 buf)33b2edd2fdSRoman Zippel static inline s32 nfhd_read_write(u32 major, u32 minor, u32 rwflag, u32 recno,
34b2edd2fdSRoman Zippel u32 count, u32 buf)
35b2edd2fdSRoman Zippel {
36b2edd2fdSRoman Zippel return nf_call(nfhd_id + NFHD_READ_WRITE, major, minor, rwflag, recno,
37b2edd2fdSRoman Zippel count, buf);
38b2edd2fdSRoman Zippel }
39b2edd2fdSRoman Zippel
nfhd_get_capacity(u32 major,u32 minor,u32 * blocks,u32 * blocksize)40b2edd2fdSRoman Zippel static inline s32 nfhd_get_capacity(u32 major, u32 minor, u32 *blocks,
41b2edd2fdSRoman Zippel u32 *blocksize)
42b2edd2fdSRoman Zippel {
4355490050SGeert Uytterhoeven return nf_call(nfhd_id + NFHD_GET_CAPACITY, major, minor,
4455490050SGeert Uytterhoeven virt_to_phys(blocks), virt_to_phys(blocksize));
45b2edd2fdSRoman Zippel }
46b2edd2fdSRoman Zippel
47b2edd2fdSRoman Zippel static LIST_HEAD(nfhd_list);
48b2edd2fdSRoman Zippel
49b2edd2fdSRoman Zippel static int major_num;
50b2edd2fdSRoman Zippel module_param(major_num, int, 0);
51b2edd2fdSRoman Zippel
52b2edd2fdSRoman Zippel struct nfhd_device {
53b2edd2fdSRoman Zippel struct list_head list;
54b2edd2fdSRoman Zippel int id;
55b2edd2fdSRoman Zippel u32 blocks, bsize;
56b2edd2fdSRoman Zippel int bshift;
57b2edd2fdSRoman Zippel struct gendisk *disk;
58b2edd2fdSRoman Zippel };
59b2edd2fdSRoman Zippel
nfhd_submit_bio(struct bio * bio)603e08773cSChristoph Hellwig static void nfhd_submit_bio(struct bio *bio)
61b2edd2fdSRoman Zippel {
62309dca30SChristoph Hellwig struct nfhd_device *dev = bio->bi_bdev->bd_disk->private_data;
637988613bSKent Overstreet struct bio_vec bvec;
647988613bSKent Overstreet struct bvec_iter iter;
657988613bSKent Overstreet int dir, len, shift;
664f024f37SKent Overstreet sector_t sec = bio->bi_iter.bi_sector;
67b2edd2fdSRoman Zippel
68b2edd2fdSRoman Zippel dir = bio_data_dir(bio);
69b2edd2fdSRoman Zippel shift = dev->bshift;
707988613bSKent Overstreet bio_for_each_segment(bvec, bio, iter) {
717988613bSKent Overstreet len = bvec.bv_len;
72b2edd2fdSRoman Zippel len >>= 9;
73b2edd2fdSRoman Zippel nfhd_read_write(dev->id, 0, dir, sec >> shift, len >> shift,
746e768461SChristoph Hellwig page_to_phys(bvec.bv_page) + bvec.bv_offset);
75b2edd2fdSRoman Zippel sec += len;
76b2edd2fdSRoman Zippel }
774246a0b6SChristoph Hellwig bio_endio(bio);
78b2edd2fdSRoman Zippel }
79b2edd2fdSRoman Zippel
nfhd_getgeo(struct block_device * bdev,struct hd_geometry * geo)80b2edd2fdSRoman Zippel static int nfhd_getgeo(struct block_device *bdev, struct hd_geometry *geo)
81b2edd2fdSRoman Zippel {
82b2edd2fdSRoman Zippel struct nfhd_device *dev = bdev->bd_disk->private_data;
83b2edd2fdSRoman Zippel
84b2edd2fdSRoman Zippel geo->cylinders = dev->blocks >> (6 - dev->bshift);
85b2edd2fdSRoman Zippel geo->heads = 4;
86b2edd2fdSRoman Zippel geo->sectors = 16;
87b2edd2fdSRoman Zippel
88b2edd2fdSRoman Zippel return 0;
89b2edd2fdSRoman Zippel }
90b2edd2fdSRoman Zippel
91b2edd2fdSRoman Zippel static const struct block_device_operations nfhd_ops = {
92b2edd2fdSRoman Zippel .owner = THIS_MODULE,
93c62b37d9SChristoph Hellwig .submit_bio = nfhd_submit_bio,
94b2edd2fdSRoman Zippel .getgeo = nfhd_getgeo,
95b2edd2fdSRoman Zippel };
96b2edd2fdSRoman Zippel
nfhd_init_one(int id,u32 blocks,u32 bsize)97b2edd2fdSRoman Zippel static int __init nfhd_init_one(int id, u32 blocks, u32 bsize)
98b2edd2fdSRoman Zippel {
99b2edd2fdSRoman Zippel struct nfhd_device *dev;
100b2edd2fdSRoman Zippel int dev_id = id - NFHD_DEV_OFFSET;
10121fd880dSLuis Chamberlain int err = -ENOMEM;
102b2edd2fdSRoman Zippel
103b2edd2fdSRoman Zippel pr_info("nfhd%u: found device with %u blocks (%u bytes)\n", dev_id,
104b2edd2fdSRoman Zippel blocks, bsize);
105b2edd2fdSRoman Zippel
106b2edd2fdSRoman Zippel if (bsize < 512 || (bsize & (bsize - 1))) {
107b2edd2fdSRoman Zippel pr_warn("nfhd%u: invalid block size\n", dev_id);
108b2edd2fdSRoman Zippel return -EINVAL;
109b2edd2fdSRoman Zippel }
110b2edd2fdSRoman Zippel
111b2edd2fdSRoman Zippel dev = kmalloc(sizeof(struct nfhd_device), GFP_KERNEL);
112b2edd2fdSRoman Zippel if (!dev)
113b2edd2fdSRoman Zippel goto out;
114b2edd2fdSRoman Zippel
115b2edd2fdSRoman Zippel dev->id = id;
116b2edd2fdSRoman Zippel dev->blocks = blocks;
117b2edd2fdSRoman Zippel dev->bsize = bsize;
118b2edd2fdSRoman Zippel dev->bshift = ffs(bsize) - 10;
119b2edd2fdSRoman Zippel
120c3e23538SChristoph Hellwig dev->disk = blk_alloc_disk(NUMA_NO_NODE);
121b2edd2fdSRoman Zippel if (!dev->disk)
122c3e23538SChristoph Hellwig goto free_dev;
123b2edd2fdSRoman Zippel
124b2edd2fdSRoman Zippel dev->disk->major = major_num;
125b2edd2fdSRoman Zippel dev->disk->first_minor = dev_id * 16;
126c3e23538SChristoph Hellwig dev->disk->minors = 16;
127b2edd2fdSRoman Zippel dev->disk->fops = &nfhd_ops;
128b2edd2fdSRoman Zippel dev->disk->private_data = dev;
129b2edd2fdSRoman Zippel sprintf(dev->disk->disk_name, "nfhd%u", dev_id);
130b2edd2fdSRoman Zippel set_capacity(dev->disk, (sector_t)blocks * (bsize / 512));
131c3e23538SChristoph Hellwig blk_queue_logical_block_size(dev->disk->queue, bsize);
13221fd880dSLuis Chamberlain err = add_disk(dev->disk);
13321fd880dSLuis Chamberlain if (err)
13421fd880dSLuis Chamberlain goto out_cleanup_disk;
135b2edd2fdSRoman Zippel
136b2edd2fdSRoman Zippel list_add_tail(&dev->list, &nfhd_list);
137b2edd2fdSRoman Zippel
138b2edd2fdSRoman Zippel return 0;
139b2edd2fdSRoman Zippel
14021fd880dSLuis Chamberlain out_cleanup_disk:
141*8b9ab626SChristoph Hellwig put_disk(dev->disk);
142b2edd2fdSRoman Zippel free_dev:
143b2edd2fdSRoman Zippel kfree(dev);
144b2edd2fdSRoman Zippel out:
14521fd880dSLuis Chamberlain return err;
146b2edd2fdSRoman Zippel }
147b2edd2fdSRoman Zippel
nfhd_init(void)148b2edd2fdSRoman Zippel static int __init nfhd_init(void)
149b2edd2fdSRoman Zippel {
150b2edd2fdSRoman Zippel u32 blocks, bsize;
15130363d65SChengguang Xu int ret;
152b2edd2fdSRoman Zippel int i;
153b2edd2fdSRoman Zippel
154b2edd2fdSRoman Zippel nfhd_id = nf_get_id("XHDI");
155b2edd2fdSRoman Zippel if (!nfhd_id)
156b2edd2fdSRoman Zippel return -ENODEV;
157b2edd2fdSRoman Zippel
15830363d65SChengguang Xu ret = register_blkdev(major_num, "nfhd");
15930363d65SChengguang Xu if (ret < 0) {
160b2edd2fdSRoman Zippel pr_warn("nfhd: unable to get major number\n");
16130363d65SChengguang Xu return ret;
162b2edd2fdSRoman Zippel }
163b2edd2fdSRoman Zippel
16430363d65SChengguang Xu if (!major_num)
16530363d65SChengguang Xu major_num = ret;
16630363d65SChengguang Xu
167b2edd2fdSRoman Zippel for (i = NFHD_DEV_OFFSET; i < 24; i++) {
168b2edd2fdSRoman Zippel if (nfhd_get_capacity(i, 0, &blocks, &bsize))
169b2edd2fdSRoman Zippel continue;
170b2edd2fdSRoman Zippel nfhd_init_one(i, blocks, bsize);
171b2edd2fdSRoman Zippel }
172b2edd2fdSRoman Zippel
173b2edd2fdSRoman Zippel return 0;
174b2edd2fdSRoman Zippel }
175b2edd2fdSRoman Zippel
nfhd_exit(void)176b2edd2fdSRoman Zippel static void __exit nfhd_exit(void)
177b2edd2fdSRoman Zippel {
178b2edd2fdSRoman Zippel struct nfhd_device *dev, *next;
179b2edd2fdSRoman Zippel
180b2edd2fdSRoman Zippel list_for_each_entry_safe(dev, next, &nfhd_list, list) {
181b2edd2fdSRoman Zippel list_del(&dev->list);
182b2edd2fdSRoman Zippel del_gendisk(dev->disk);
183*8b9ab626SChristoph Hellwig put_disk(dev->disk);
184b2edd2fdSRoman Zippel kfree(dev);
185b2edd2fdSRoman Zippel }
186b2edd2fdSRoman Zippel unregister_blkdev(major_num, "nfhd");
187b2edd2fdSRoman Zippel }
188b2edd2fdSRoman Zippel
189b2edd2fdSRoman Zippel module_init(nfhd_init);
190b2edd2fdSRoman Zippel module_exit(nfhd_exit);
191b2edd2fdSRoman Zippel
192b2edd2fdSRoman Zippel MODULE_LICENSE("GPL");
193