162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0 262306a36Sopenharmony_ci/* 362306a36Sopenharmony_ci * Copyright IBM Corp. 2004 462306a36Sopenharmony_ci * 562306a36Sopenharmony_ci * Tape class device support 662306a36Sopenharmony_ci * 762306a36Sopenharmony_ci * Author: Stefan Bader <shbader@de.ibm.com> 862306a36Sopenharmony_ci * Based on simple class device code by Greg K-H 962306a36Sopenharmony_ci */ 1062306a36Sopenharmony_ci 1162306a36Sopenharmony_ci#define KMSG_COMPONENT "tape" 1262306a36Sopenharmony_ci#define pr_fmt(fmt) KMSG_COMPONENT ": " fmt 1362306a36Sopenharmony_ci 1462306a36Sopenharmony_ci#include <linux/slab.h> 1562306a36Sopenharmony_ci 1662306a36Sopenharmony_ci#include "tape_class.h" 1762306a36Sopenharmony_ci 1862306a36Sopenharmony_ciMODULE_AUTHOR("Stefan Bader <shbader@de.ibm.com>"); 1962306a36Sopenharmony_ciMODULE_DESCRIPTION( 2062306a36Sopenharmony_ci "Copyright IBM Corp. 2004 All Rights Reserved.\n" 2162306a36Sopenharmony_ci "tape_class.c" 2262306a36Sopenharmony_ci); 2362306a36Sopenharmony_ciMODULE_LICENSE("GPL"); 2462306a36Sopenharmony_ci 2562306a36Sopenharmony_cistatic struct class *tape_class; 2662306a36Sopenharmony_ci 2762306a36Sopenharmony_ci/* 2862306a36Sopenharmony_ci * Register a tape device and return a pointer to the cdev structure. 2962306a36Sopenharmony_ci * 3062306a36Sopenharmony_ci * device 3162306a36Sopenharmony_ci * The pointer to the struct device of the physical (base) device. 3262306a36Sopenharmony_ci * drivername 3362306a36Sopenharmony_ci * The pointer to the drivers name for it's character devices. 3462306a36Sopenharmony_ci * dev 3562306a36Sopenharmony_ci * The intended major/minor number. The major number may be 0 to 3662306a36Sopenharmony_ci * get a dynamic major number. 3762306a36Sopenharmony_ci * fops 3862306a36Sopenharmony_ci * The pointer to the drivers file operations for the tape device. 3962306a36Sopenharmony_ci * devname 4062306a36Sopenharmony_ci * The pointer to the name of the character device. 4162306a36Sopenharmony_ci */ 4262306a36Sopenharmony_cistruct tape_class_device *register_tape_dev( 4362306a36Sopenharmony_ci struct device * device, 4462306a36Sopenharmony_ci dev_t dev, 4562306a36Sopenharmony_ci const struct file_operations *fops, 4662306a36Sopenharmony_ci char * device_name, 4762306a36Sopenharmony_ci char * mode_name) 4862306a36Sopenharmony_ci{ 4962306a36Sopenharmony_ci struct tape_class_device * tcd; 5062306a36Sopenharmony_ci int rc; 5162306a36Sopenharmony_ci char * s; 5262306a36Sopenharmony_ci 5362306a36Sopenharmony_ci tcd = kzalloc(sizeof(struct tape_class_device), GFP_KERNEL); 5462306a36Sopenharmony_ci if (!tcd) 5562306a36Sopenharmony_ci return ERR_PTR(-ENOMEM); 5662306a36Sopenharmony_ci 5762306a36Sopenharmony_ci strscpy(tcd->device_name, device_name, TAPECLASS_NAME_LEN); 5862306a36Sopenharmony_ci for (s = strchr(tcd->device_name, '/'); s; s = strchr(s, '/')) 5962306a36Sopenharmony_ci *s = '!'; 6062306a36Sopenharmony_ci strscpy(tcd->mode_name, mode_name, TAPECLASS_NAME_LEN); 6162306a36Sopenharmony_ci for (s = strchr(tcd->mode_name, '/'); s; s = strchr(s, '/')) 6262306a36Sopenharmony_ci *s = '!'; 6362306a36Sopenharmony_ci 6462306a36Sopenharmony_ci tcd->char_device = cdev_alloc(); 6562306a36Sopenharmony_ci if (!tcd->char_device) { 6662306a36Sopenharmony_ci rc = -ENOMEM; 6762306a36Sopenharmony_ci goto fail_with_tcd; 6862306a36Sopenharmony_ci } 6962306a36Sopenharmony_ci 7062306a36Sopenharmony_ci tcd->char_device->owner = fops->owner; 7162306a36Sopenharmony_ci tcd->char_device->ops = fops; 7262306a36Sopenharmony_ci 7362306a36Sopenharmony_ci rc = cdev_add(tcd->char_device, dev, 1); 7462306a36Sopenharmony_ci if (rc) 7562306a36Sopenharmony_ci goto fail_with_cdev; 7662306a36Sopenharmony_ci 7762306a36Sopenharmony_ci tcd->class_device = device_create(tape_class, device, 7862306a36Sopenharmony_ci tcd->char_device->dev, NULL, 7962306a36Sopenharmony_ci "%s", tcd->device_name); 8062306a36Sopenharmony_ci rc = PTR_ERR_OR_ZERO(tcd->class_device); 8162306a36Sopenharmony_ci if (rc) 8262306a36Sopenharmony_ci goto fail_with_cdev; 8362306a36Sopenharmony_ci rc = sysfs_create_link( 8462306a36Sopenharmony_ci &device->kobj, 8562306a36Sopenharmony_ci &tcd->class_device->kobj, 8662306a36Sopenharmony_ci tcd->mode_name 8762306a36Sopenharmony_ci ); 8862306a36Sopenharmony_ci if (rc) 8962306a36Sopenharmony_ci goto fail_with_class_device; 9062306a36Sopenharmony_ci 9162306a36Sopenharmony_ci return tcd; 9262306a36Sopenharmony_ci 9362306a36Sopenharmony_cifail_with_class_device: 9462306a36Sopenharmony_ci device_destroy(tape_class, tcd->char_device->dev); 9562306a36Sopenharmony_ci 9662306a36Sopenharmony_cifail_with_cdev: 9762306a36Sopenharmony_ci cdev_del(tcd->char_device); 9862306a36Sopenharmony_ci 9962306a36Sopenharmony_cifail_with_tcd: 10062306a36Sopenharmony_ci kfree(tcd); 10162306a36Sopenharmony_ci 10262306a36Sopenharmony_ci return ERR_PTR(rc); 10362306a36Sopenharmony_ci} 10462306a36Sopenharmony_ciEXPORT_SYMBOL(register_tape_dev); 10562306a36Sopenharmony_ci 10662306a36Sopenharmony_civoid unregister_tape_dev(struct device *device, struct tape_class_device *tcd) 10762306a36Sopenharmony_ci{ 10862306a36Sopenharmony_ci if (tcd != NULL && !IS_ERR(tcd)) { 10962306a36Sopenharmony_ci sysfs_remove_link(&device->kobj, tcd->mode_name); 11062306a36Sopenharmony_ci device_destroy(tape_class, tcd->char_device->dev); 11162306a36Sopenharmony_ci cdev_del(tcd->char_device); 11262306a36Sopenharmony_ci kfree(tcd); 11362306a36Sopenharmony_ci } 11462306a36Sopenharmony_ci} 11562306a36Sopenharmony_ciEXPORT_SYMBOL(unregister_tape_dev); 11662306a36Sopenharmony_ci 11762306a36Sopenharmony_ci 11862306a36Sopenharmony_cistatic int __init tape_init(void) 11962306a36Sopenharmony_ci{ 12062306a36Sopenharmony_ci tape_class = class_create("tape390"); 12162306a36Sopenharmony_ci 12262306a36Sopenharmony_ci return 0; 12362306a36Sopenharmony_ci} 12462306a36Sopenharmony_ci 12562306a36Sopenharmony_cistatic void __exit tape_exit(void) 12662306a36Sopenharmony_ci{ 12762306a36Sopenharmony_ci class_destroy(tape_class); 12862306a36Sopenharmony_ci tape_class = NULL; 12962306a36Sopenharmony_ci} 13062306a36Sopenharmony_ci 13162306a36Sopenharmony_cipostcore_initcall(tape_init); 13262306a36Sopenharmony_cimodule_exit(tape_exit); 133