162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0 or BSD-3-Clause
262306a36Sopenharmony_ci/*
362306a36Sopenharmony_ci * Copyright(c) 2015, 2016 Intel Corporation.
462306a36Sopenharmony_ci */
562306a36Sopenharmony_ci
662306a36Sopenharmony_ci#include <linux/cdev.h>
762306a36Sopenharmony_ci#include <linux/device.h>
862306a36Sopenharmony_ci#include <linux/fs.h>
962306a36Sopenharmony_ci
1062306a36Sopenharmony_ci#include "hfi.h"
1162306a36Sopenharmony_ci#include "device.h"
1262306a36Sopenharmony_ci
1362306a36Sopenharmony_cistatic char *hfi1_devnode(const struct device *dev, umode_t *mode)
1462306a36Sopenharmony_ci{
1562306a36Sopenharmony_ci	if (mode)
1662306a36Sopenharmony_ci		*mode = 0600;
1762306a36Sopenharmony_ci	return kasprintf(GFP_KERNEL, "%s", dev_name(dev));
1862306a36Sopenharmony_ci}
1962306a36Sopenharmony_ci
2062306a36Sopenharmony_cistatic const struct class class = {
2162306a36Sopenharmony_ci	.name = "hfi1",
2262306a36Sopenharmony_ci	.devnode = hfi1_devnode,
2362306a36Sopenharmony_ci};
2462306a36Sopenharmony_ci
2562306a36Sopenharmony_cistatic char *hfi1_user_devnode(const struct device *dev, umode_t *mode)
2662306a36Sopenharmony_ci{
2762306a36Sopenharmony_ci	if (mode)
2862306a36Sopenharmony_ci		*mode = 0666;
2962306a36Sopenharmony_ci	return kasprintf(GFP_KERNEL, "%s", dev_name(dev));
3062306a36Sopenharmony_ci}
3162306a36Sopenharmony_ci
3262306a36Sopenharmony_cistatic const struct class user_class = {
3362306a36Sopenharmony_ci	.name = "hfi1_user",
3462306a36Sopenharmony_ci	.devnode = hfi1_user_devnode,
3562306a36Sopenharmony_ci};
3662306a36Sopenharmony_cistatic dev_t hfi1_dev;
3762306a36Sopenharmony_ci
3862306a36Sopenharmony_ciint hfi1_cdev_init(int minor, const char *name,
3962306a36Sopenharmony_ci		   const struct file_operations *fops,
4062306a36Sopenharmony_ci		   struct cdev *cdev, struct device **devp,
4162306a36Sopenharmony_ci		   bool user_accessible,
4262306a36Sopenharmony_ci		   struct kobject *parent)
4362306a36Sopenharmony_ci{
4462306a36Sopenharmony_ci	const dev_t dev = MKDEV(MAJOR(hfi1_dev), minor);
4562306a36Sopenharmony_ci	struct device *device = NULL;
4662306a36Sopenharmony_ci	int ret;
4762306a36Sopenharmony_ci
4862306a36Sopenharmony_ci	cdev_init(cdev, fops);
4962306a36Sopenharmony_ci	cdev->owner = THIS_MODULE;
5062306a36Sopenharmony_ci	cdev_set_parent(cdev, parent);
5162306a36Sopenharmony_ci	kobject_set_name(&cdev->kobj, name);
5262306a36Sopenharmony_ci
5362306a36Sopenharmony_ci	ret = cdev_add(cdev, dev, 1);
5462306a36Sopenharmony_ci	if (ret < 0) {
5562306a36Sopenharmony_ci		pr_err("Could not add cdev for minor %d, %s (err %d)\n",
5662306a36Sopenharmony_ci		       minor, name, -ret);
5762306a36Sopenharmony_ci		goto done;
5862306a36Sopenharmony_ci	}
5962306a36Sopenharmony_ci
6062306a36Sopenharmony_ci	if (user_accessible)
6162306a36Sopenharmony_ci		device = device_create(&user_class, NULL, dev, NULL, "%s", name);
6262306a36Sopenharmony_ci	else
6362306a36Sopenharmony_ci		device = device_create(&class, NULL, dev, NULL, "%s", name);
6462306a36Sopenharmony_ci
6562306a36Sopenharmony_ci	if (IS_ERR(device)) {
6662306a36Sopenharmony_ci		ret = PTR_ERR(device);
6762306a36Sopenharmony_ci		device = NULL;
6862306a36Sopenharmony_ci		pr_err("Could not create device for minor %d, %s (err %d)\n",
6962306a36Sopenharmony_ci			minor, name, -ret);
7062306a36Sopenharmony_ci		cdev_del(cdev);
7162306a36Sopenharmony_ci	}
7262306a36Sopenharmony_cidone:
7362306a36Sopenharmony_ci	*devp = device;
7462306a36Sopenharmony_ci	return ret;
7562306a36Sopenharmony_ci}
7662306a36Sopenharmony_ci
7762306a36Sopenharmony_civoid hfi1_cdev_cleanup(struct cdev *cdev, struct device **devp)
7862306a36Sopenharmony_ci{
7962306a36Sopenharmony_ci	struct device *device = *devp;
8062306a36Sopenharmony_ci
8162306a36Sopenharmony_ci	if (device) {
8262306a36Sopenharmony_ci		device_unregister(device);
8362306a36Sopenharmony_ci		*devp = NULL;
8462306a36Sopenharmony_ci
8562306a36Sopenharmony_ci		cdev_del(cdev);
8662306a36Sopenharmony_ci	}
8762306a36Sopenharmony_ci}
8862306a36Sopenharmony_ci
8962306a36Sopenharmony_cistatic const char *hfi1_class_name = "hfi1";
9062306a36Sopenharmony_ci
9162306a36Sopenharmony_ciconst char *class_name(void)
9262306a36Sopenharmony_ci{
9362306a36Sopenharmony_ci	return hfi1_class_name;
9462306a36Sopenharmony_ci}
9562306a36Sopenharmony_ci
9662306a36Sopenharmony_ciint __init dev_init(void)
9762306a36Sopenharmony_ci{
9862306a36Sopenharmony_ci	int ret;
9962306a36Sopenharmony_ci
10062306a36Sopenharmony_ci	ret = alloc_chrdev_region(&hfi1_dev, 0, HFI1_NMINORS, DRIVER_NAME);
10162306a36Sopenharmony_ci	if (ret < 0) {
10262306a36Sopenharmony_ci		pr_err("Could not allocate chrdev region (err %d)\n", -ret);
10362306a36Sopenharmony_ci		goto done;
10462306a36Sopenharmony_ci	}
10562306a36Sopenharmony_ci
10662306a36Sopenharmony_ci	ret = class_register(&class);
10762306a36Sopenharmony_ci	if (ret) {
10862306a36Sopenharmony_ci		pr_err("Could not create device class (err %d)\n", -ret);
10962306a36Sopenharmony_ci		unregister_chrdev_region(hfi1_dev, HFI1_NMINORS);
11062306a36Sopenharmony_ci		goto done;
11162306a36Sopenharmony_ci	}
11262306a36Sopenharmony_ci
11362306a36Sopenharmony_ci	ret = class_register(&user_class);
11462306a36Sopenharmony_ci	if (ret) {
11562306a36Sopenharmony_ci		pr_err("Could not create device class for user accessible files (err %d)\n",
11662306a36Sopenharmony_ci		       -ret);
11762306a36Sopenharmony_ci		class_unregister(&class);
11862306a36Sopenharmony_ci		unregister_chrdev_region(hfi1_dev, HFI1_NMINORS);
11962306a36Sopenharmony_ci		goto done;
12062306a36Sopenharmony_ci	}
12162306a36Sopenharmony_ci
12262306a36Sopenharmony_cidone:
12362306a36Sopenharmony_ci	return ret;
12462306a36Sopenharmony_ci}
12562306a36Sopenharmony_ci
12662306a36Sopenharmony_civoid dev_cleanup(void)
12762306a36Sopenharmony_ci{
12862306a36Sopenharmony_ci	class_unregister(&class);
12962306a36Sopenharmony_ci	class_unregister(&user_class);
13062306a36Sopenharmony_ci
13162306a36Sopenharmony_ci	unregister_chrdev_region(hfi1_dev, HFI1_NMINORS);
13262306a36Sopenharmony_ci}
133