]>
git.proxmox.com Git - mirror_ubuntu-jammy-kernel.git/blob - drivers/misc/tifm_core.c
1 // SPDX-License-Identifier: GPL-2.0-only
3 * tifm_core.c - TI FlashMedia driver
5 * Copyright (C) 2006 Alex Dubov <oakad@yahoo.com>
8 #include <linux/tifm.h>
9 #include <linux/slab.h>
10 #include <linux/init.h>
11 #include <linux/idr.h>
12 #include <linux/module.h>
14 #define DRIVER_NAME "tifm_core"
15 #define DRIVER_VERSION "0.8"
17 static struct workqueue_struct
*workqueue
;
18 static DEFINE_IDR(tifm_adapter_idr
);
19 static DEFINE_SPINLOCK(tifm_adapter_lock
);
21 static const char *tifm_media_type_name(unsigned char type
, unsigned char nt
)
23 const char *card_type_name
[3][3] = {
24 { "SmartMedia/xD", "MemoryStick", "MMC/SD" },
29 if (nt
> 2 || type
< 1 || type
> 3)
31 return card_type_name
[nt
][type
- 1];
34 static int tifm_dev_match(struct tifm_dev
*sock
, struct tifm_device_id
*id
)
36 if (sock
->type
== id
->type
)
41 static int tifm_bus_match(struct device
*dev
, struct device_driver
*drv
)
43 struct tifm_dev
*sock
= container_of(dev
, struct tifm_dev
, dev
);
44 struct tifm_driver
*fm_drv
= container_of(drv
, struct tifm_driver
,
46 struct tifm_device_id
*ids
= fm_drv
->id_table
;
50 if (tifm_dev_match(sock
, ids
))
58 static int tifm_uevent(struct device
*dev
, struct kobj_uevent_env
*env
)
60 struct tifm_dev
*sock
= container_of(dev
, struct tifm_dev
, dev
);
62 if (add_uevent_var(env
, "TIFM_CARD_TYPE=%s", tifm_media_type_name(sock
->type
, 1)))
68 static int tifm_device_probe(struct device
*dev
)
70 struct tifm_dev
*sock
= container_of(dev
, struct tifm_dev
, dev
);
71 struct tifm_driver
*drv
= container_of(dev
->driver
, struct tifm_driver
,
76 if (dev
->driver
&& drv
->probe
) {
77 rc
= drv
->probe(sock
);
85 static void tifm_dummy_event(struct tifm_dev
*sock
)
90 static void tifm_device_remove(struct device
*dev
)
92 struct tifm_dev
*sock
= container_of(dev
, struct tifm_dev
, dev
);
93 struct tifm_driver
*drv
= container_of(dev
->driver
, struct tifm_driver
,
96 if (dev
->driver
&& drv
->remove
) {
97 sock
->card_event
= tifm_dummy_event
;
98 sock
->data_event
= tifm_dummy_event
;
100 sock
->dev
.driver
= NULL
;
108 static int tifm_device_suspend(struct device
*dev
, pm_message_t state
)
110 struct tifm_dev
*sock
= container_of(dev
, struct tifm_dev
, dev
);
111 struct tifm_driver
*drv
= container_of(dev
->driver
, struct tifm_driver
,
114 if (dev
->driver
&& drv
->suspend
)
115 return drv
->suspend(sock
, state
);
119 static int tifm_device_resume(struct device
*dev
)
121 struct tifm_dev
*sock
= container_of(dev
, struct tifm_dev
, dev
);
122 struct tifm_driver
*drv
= container_of(dev
->driver
, struct tifm_driver
,
125 if (dev
->driver
&& drv
->resume
)
126 return drv
->resume(sock
);
132 #define tifm_device_suspend NULL
133 #define tifm_device_resume NULL
135 #endif /* CONFIG_PM */
137 static ssize_t
type_show(struct device
*dev
, struct device_attribute
*attr
,
140 struct tifm_dev
*sock
= container_of(dev
, struct tifm_dev
, dev
);
141 return sprintf(buf
, "%x", sock
->type
);
143 static DEVICE_ATTR_RO(type
);
145 static struct attribute
*tifm_dev_attrs
[] = {
149 ATTRIBUTE_GROUPS(tifm_dev
);
151 static struct bus_type tifm_bus_type
= {
153 .dev_groups
= tifm_dev_groups
,
154 .match
= tifm_bus_match
,
155 .uevent
= tifm_uevent
,
156 .probe
= tifm_device_probe
,
157 .remove
= tifm_device_remove
,
158 .suspend
= tifm_device_suspend
,
159 .resume
= tifm_device_resume
162 static void tifm_free(struct device
*dev
)
164 struct tifm_adapter
*fm
= container_of(dev
, struct tifm_adapter
, dev
);
169 static struct class tifm_adapter_class
= {
170 .name
= "tifm_adapter",
171 .dev_release
= tifm_free
174 struct tifm_adapter
*tifm_alloc_adapter(unsigned int num_sockets
,
177 struct tifm_adapter
*fm
;
179 fm
= kzalloc(sizeof(struct tifm_adapter
)
180 + sizeof(struct tifm_dev
*) * num_sockets
, GFP_KERNEL
);
182 fm
->dev
.class = &tifm_adapter_class
;
183 fm
->dev
.parent
= dev
;
184 device_initialize(&fm
->dev
);
185 spin_lock_init(&fm
->lock
);
186 fm
->num_sockets
= num_sockets
;
190 EXPORT_SYMBOL(tifm_alloc_adapter
);
192 int tifm_add_adapter(struct tifm_adapter
*fm
)
196 idr_preload(GFP_KERNEL
);
197 spin_lock(&tifm_adapter_lock
);
198 rc
= idr_alloc(&tifm_adapter_idr
, fm
, 0, 0, GFP_NOWAIT
);
201 spin_unlock(&tifm_adapter_lock
);
206 dev_set_name(&fm
->dev
, "tifm%u", fm
->id
);
207 rc
= device_add(&fm
->dev
);
209 spin_lock(&tifm_adapter_lock
);
210 idr_remove(&tifm_adapter_idr
, fm
->id
);
211 spin_unlock(&tifm_adapter_lock
);
216 EXPORT_SYMBOL(tifm_add_adapter
);
218 void tifm_remove_adapter(struct tifm_adapter
*fm
)
222 flush_workqueue(workqueue
);
223 for (cnt
= 0; cnt
< fm
->num_sockets
; ++cnt
) {
224 if (fm
->sockets
[cnt
])
225 device_unregister(&fm
->sockets
[cnt
]->dev
);
228 spin_lock(&tifm_adapter_lock
);
229 idr_remove(&tifm_adapter_idr
, fm
->id
);
230 spin_unlock(&tifm_adapter_lock
);
231 device_del(&fm
->dev
);
233 EXPORT_SYMBOL(tifm_remove_adapter
);
235 void tifm_free_adapter(struct tifm_adapter
*fm
)
237 put_device(&fm
->dev
);
239 EXPORT_SYMBOL(tifm_free_adapter
);
241 void tifm_free_device(struct device
*dev
)
243 struct tifm_dev
*sock
= container_of(dev
, struct tifm_dev
, dev
);
246 EXPORT_SYMBOL(tifm_free_device
);
248 struct tifm_dev
*tifm_alloc_device(struct tifm_adapter
*fm
, unsigned int id
,
251 struct tifm_dev
*sock
= NULL
;
253 if (!tifm_media_type_name(type
, 0))
256 sock
= kzalloc(sizeof(struct tifm_dev
), GFP_KERNEL
);
258 spin_lock_init(&sock
->lock
);
260 sock
->socket_id
= id
;
261 sock
->card_event
= tifm_dummy_event
;
262 sock
->data_event
= tifm_dummy_event
;
264 sock
->dev
.parent
= fm
->dev
.parent
;
265 sock
->dev
.bus
= &tifm_bus_type
;
266 sock
->dev
.dma_mask
= fm
->dev
.parent
->dma_mask
;
267 sock
->dev
.release
= tifm_free_device
;
269 dev_set_name(&sock
->dev
, "tifm_%s%u:%u",
270 tifm_media_type_name(type
, 2), fm
->id
, id
);
271 printk(KERN_INFO DRIVER_NAME
272 ": %s card detected in socket %u:%u\n",
273 tifm_media_type_name(type
, 0), fm
->id
, id
);
277 EXPORT_SYMBOL(tifm_alloc_device
);
279 void tifm_eject(struct tifm_dev
*sock
)
281 struct tifm_adapter
*fm
= dev_get_drvdata(sock
->dev
.parent
);
284 EXPORT_SYMBOL(tifm_eject
);
286 int tifm_has_ms_pif(struct tifm_dev
*sock
)
288 struct tifm_adapter
*fm
= dev_get_drvdata(sock
->dev
.parent
);
289 return fm
->has_ms_pif(fm
, sock
);
291 EXPORT_SYMBOL(tifm_has_ms_pif
);
293 int tifm_map_sg(struct tifm_dev
*sock
, struct scatterlist
*sg
, int nents
,
296 return pci_map_sg(to_pci_dev(sock
->dev
.parent
), sg
, nents
, direction
);
298 EXPORT_SYMBOL(tifm_map_sg
);
300 void tifm_unmap_sg(struct tifm_dev
*sock
, struct scatterlist
*sg
, int nents
,
303 pci_unmap_sg(to_pci_dev(sock
->dev
.parent
), sg
, nents
, direction
);
305 EXPORT_SYMBOL(tifm_unmap_sg
);
307 void tifm_queue_work(struct work_struct
*work
)
309 queue_work(workqueue
, work
);
311 EXPORT_SYMBOL(tifm_queue_work
);
313 int tifm_register_driver(struct tifm_driver
*drv
)
315 drv
->driver
.bus
= &tifm_bus_type
;
317 return driver_register(&drv
->driver
);
319 EXPORT_SYMBOL(tifm_register_driver
);
321 void tifm_unregister_driver(struct tifm_driver
*drv
)
323 driver_unregister(&drv
->driver
);
325 EXPORT_SYMBOL(tifm_unregister_driver
);
327 static int __init
tifm_init(void)
331 workqueue
= create_freezable_workqueue("tifm");
335 rc
= bus_register(&tifm_bus_type
);
340 rc
= class_register(&tifm_adapter_class
);
344 bus_unregister(&tifm_bus_type
);
347 destroy_workqueue(workqueue
);
352 static void __exit
tifm_exit(void)
354 class_unregister(&tifm_adapter_class
);
355 bus_unregister(&tifm_bus_type
);
356 destroy_workqueue(workqueue
);
359 subsys_initcall(tifm_init
);
360 module_exit(tifm_exit
);
362 MODULE_LICENSE("GPL");
363 MODULE_AUTHOR("Alex Dubov");
364 MODULE_DESCRIPTION("TI FlashMedia core driver");
365 MODULE_LICENSE("GPL");
366 MODULE_VERSION(DRIVER_VERSION
);