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