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