Commit | Line | Data |
---|---|---|
d9b2a2bb LK |
1 | // SPDX-License-Identifier: GPL-2.0 |
2 | /* | |
3 | * Support for the N64 cart. | |
4 | * | |
5 | * Copyright (c) 2021 Lauri Kasanen | |
6 | */ | |
7 | ||
f1e19224 | 8 | #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt |
d9b2a2bb LK |
9 | #include <linux/bitops.h> |
10 | #include <linux/blkdev.h> | |
11 | #include <linux/dma-mapping.h> | |
12 | #include <linux/init.h> | |
13 | #include <linux/module.h> | |
14 | #include <linux/platform_device.h> | |
15 | ||
2ce503b3 CK |
16 | enum { |
17 | PI_DRAM_REG = 0, | |
18 | PI_CART_REG, | |
19 | PI_READ_REG, | |
20 | PI_WRITE_REG, | |
21 | PI_STATUS_REG, | |
22 | }; | |
d9b2a2bb LK |
23 | |
24 | #define PI_STATUS_DMA_BUSY (1 << 0) | |
25 | #define PI_STATUS_IO_BUSY (1 << 1) | |
26 | ||
27 | #define CART_DOMAIN 0x10000000 | |
28 | #define CART_MAX 0x1FFFFFFF | |
29 | ||
30 | #define MIN_ALIGNMENT 8 | |
31 | ||
e39e3132 | 32 | static u32 __iomem *reg_base; |
e39e3132 CK |
33 | |
34 | static unsigned int start; | |
35 | module_param(start, uint, 0); | |
36 | MODULE_PARM_DESC(start, "Start address of the cart block data"); | |
37 | ||
38 | static unsigned int size; | |
39 | module_param(size, uint, 0); | |
40 | MODULE_PARM_DESC(size, "Size of the cart block data, in bytes"); | |
41 | ||
d9b2a2bb LK |
42 | static void n64cart_write_reg(const u8 reg, const u32 value) |
43 | { | |
44 | writel(value, reg_base + reg); | |
45 | } | |
46 | ||
47 | static u32 n64cart_read_reg(const u8 reg) | |
48 | { | |
49 | return readl(reg_base + reg); | |
50 | } | |
51 | ||
52 | static void n64cart_wait_dma(void) | |
53 | { | |
54 | while (n64cart_read_reg(PI_STATUS_REG) & | |
55 | (PI_STATUS_DMA_BUSY | PI_STATUS_IO_BUSY)) | |
56 | cpu_relax(); | |
57 | } | |
58 | ||
59 | /* | |
60 | * Process a single bvec of a bio. | |
61 | */ | |
62 | static bool n64cart_do_bvec(struct device *dev, struct bio_vec *bv, u32 pos) | |
63 | { | |
64 | dma_addr_t dma_addr; | |
65 | const u32 bstart = pos + start; | |
66 | ||
67 | /* Alignment check */ | |
68 | WARN_ON_ONCE((bv->bv_offset & (MIN_ALIGNMENT - 1)) || | |
69 | (bv->bv_len & (MIN_ALIGNMENT - 1))); | |
70 | ||
71 | dma_addr = dma_map_bvec(dev, bv, DMA_FROM_DEVICE, 0); | |
72 | if (dma_mapping_error(dev, dma_addr)) | |
73 | return false; | |
74 | ||
75 | n64cart_wait_dma(); | |
76 | ||
402e0b8c | 77 | n64cart_write_reg(PI_DRAM_REG, dma_addr); |
d9b2a2bb LK |
78 | n64cart_write_reg(PI_CART_REG, (bstart | CART_DOMAIN) & CART_MAX); |
79 | n64cart_write_reg(PI_WRITE_REG, bv->bv_len - 1); | |
80 | ||
81 | n64cart_wait_dma(); | |
82 | ||
83 | dma_unmap_page(dev, dma_addr, bv->bv_len, DMA_FROM_DEVICE); | |
84 | return true; | |
85 | } | |
86 | ||
3e08773c | 87 | static void n64cart_submit_bio(struct bio *bio) |
d9b2a2bb LK |
88 | { |
89 | struct bio_vec bvec; | |
d9b2a2bb | 90 | struct bvec_iter iter; |
b2479de3 | 91 | struct device *dev = bio->bi_bdev->bd_disk->private_data; |
37772f91 | 92 | u32 pos = bio->bi_iter.bi_sector << SECTOR_SHIFT; |
d9b2a2bb LK |
93 | |
94 | bio_for_each_segment(bvec, bio, iter) { | |
3e08773c CH |
95 | if (!n64cart_do_bvec(dev, &bvec, pos)) { |
96 | bio_io_error(bio); | |
97 | return; | |
98 | } | |
d9b2a2bb LK |
99 | pos += bvec.bv_len; |
100 | } | |
101 | ||
102 | bio_endio(bio); | |
d9b2a2bb LK |
103 | } |
104 | ||
105 | static const struct block_device_operations n64cart_fops = { | |
106 | .owner = THIS_MODULE, | |
107 | .submit_bio = n64cart_submit_bio, | |
108 | }; | |
109 | ||
110 | /* | |
111 | * The target device is embedded and RAM-constrained. We save RAM | |
112 | * by initializing in __init code that gets dropped late in boot. | |
113 | * For the same reason there is no module or unloading support. | |
114 | */ | |
115 | static int __init n64cart_probe(struct platform_device *pdev) | |
116 | { | |
cc7f05c7 CH |
117 | struct queue_limits lim = { |
118 | .physical_block_size = 4096, | |
119 | .logical_block_size = 4096, | |
120 | }; | |
d9b2a2bb | 121 | struct gendisk *disk; |
d1df6021 | 122 | int err = -ENOMEM; |
d9b2a2bb LK |
123 | |
124 | if (!start || !size) { | |
f1e19224 | 125 | pr_err("start or size not specified\n"); |
d9b2a2bb LK |
126 | return -ENODEV; |
127 | } | |
128 | ||
129 | if (size & 4095) { | |
f1e19224 | 130 | pr_err("size must be a multiple of 4K\n"); |
d9b2a2bb LK |
131 | return -ENODEV; |
132 | } | |
133 | ||
d9b2a2bb | 134 | reg_base = devm_platform_ioremap_resource(pdev, 0); |
221e8360 YY |
135 | if (IS_ERR(reg_base)) |
136 | return PTR_ERR(reg_base); | |
d9b2a2bb | 137 | |
cc7f05c7 | 138 | disk = blk_alloc_disk(&lim, NUMA_NO_NODE); |
74fa8f9c CH |
139 | if (IS_ERR(disk)) { |
140 | err = PTR_ERR(disk); | |
d1df6021 | 141 | goto out; |
74fa8f9c | 142 | } |
0d424780 | 143 | |
d9b2a2bb | 144 | disk->first_minor = 0; |
46e7eac6 | 145 | disk->flags = GENHD_FL_NO_PART; |
d9b2a2bb | 146 | disk->fops = &n64cart_fops; |
13d41b53 | 147 | disk->private_data = &pdev->dev; |
d9b2a2bb LK |
148 | strcpy(disk->disk_name, "n64cart"); |
149 | ||
857f6fde | 150 | set_capacity(disk, size >> SECTOR_SHIFT); |
d9b2a2bb LK |
151 | set_disk_ro(disk, 1); |
152 | ||
0d424780 | 153 | blk_queue_flag_set(QUEUE_FLAG_NONROT, disk->queue); |
d9b2a2bb | 154 | |
d1df6021 LC |
155 | err = add_disk(disk); |
156 | if (err) | |
157 | goto out_cleanup_disk; | |
d9b2a2bb LK |
158 | |
159 | pr_info("n64cart: %u kb disk\n", size / 1024); | |
160 | ||
161 | return 0; | |
d1df6021 LC |
162 | |
163 | out_cleanup_disk: | |
8b9ab626 | 164 | put_disk(disk); |
d1df6021 LC |
165 | out: |
166 | return err; | |
d9b2a2bb LK |
167 | } |
168 | ||
169 | static struct platform_driver n64cart_driver = { | |
170 | .driver = { | |
171 | .name = "n64cart", | |
172 | }, | |
173 | }; | |
174 | ||
175 | static int __init n64cart_init(void) | |
176 | { | |
177 | return platform_driver_probe(&n64cart_driver, n64cart_probe); | |
178 | } | |
179 | ||
d9b2a2bb | 180 | module_init(n64cart_init); |
9ee8c9a1 CK |
181 | |
182 | MODULE_AUTHOR("Lauri Kasanen <cand@gmx.com>"); | |
183 | MODULE_DESCRIPTION("Driver for the N64 cart"); | |
184 | MODULE_LICENSE("GPL"); |