Orange Pi5 kernel

^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  1) // SPDX-License-Identifier: GPL-2.0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  3)  * Device driver for s390 storage class memory.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  4)  *
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  5)  * Copyright IBM Corp. 2012
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  6)  * Author(s): Sebastian Ott <sebott@linux.vnet.ibm.com>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  7)  */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  8) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  9) #define KMSG_COMPONENT "scm_block"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) #define pr_fmt(fmt) KMSG_COMPONENT ": " fmt
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14) #include <asm/eadm.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) #include "scm_blk.h"
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) static void scm_notify(struct scm_device *scmdev, enum scm_event event)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) 	struct scm_blk_dev *bdev = dev_get_drvdata(&scmdev->dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) 	switch (event) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) 	case SCM_CHANGE:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) 		pr_info("%lx: The capabilities of the SCM increment changed\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) 			(unsigned long) scmdev->address);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) 		SCM_LOG(2, "State changed");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) 		SCM_LOG_STATE(2, scmdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) 	case SCM_AVAIL:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) 		SCM_LOG(2, "Increment available");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) 		SCM_LOG_STATE(2, scmdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) 		scm_blk_set_available(bdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) static int scm_probe(struct scm_device *scmdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) 	struct scm_blk_dev *bdev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39) 	int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) 	SCM_LOG(2, "probe");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) 	SCM_LOG_STATE(2, scmdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44) 	if (scmdev->attrs.oper_state != OP_STATE_GOOD)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) 	bdev = kzalloc(sizeof(*bdev), GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) 	if (!bdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) 		return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) 	dev_set_drvdata(&scmdev->dev, bdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) 	ret = scm_blk_dev_setup(bdev, scmdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) 	if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54) 		dev_set_drvdata(&scmdev->dev, NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) 		kfree(bdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) 		goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) out:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) 	return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63) static int scm_remove(struct scm_device *scmdev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) 	struct scm_blk_dev *bdev = dev_get_drvdata(&scmdev->dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) 	scm_blk_dev_cleanup(bdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68) 	dev_set_drvdata(&scmdev->dev, NULL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) 	kfree(bdev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) static struct scm_driver scm_drv = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) 	.drv = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) 		.name = "scm_block",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77) 		.owner = THIS_MODULE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) 	},
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) 	.notify = scm_notify,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80) 	.probe = scm_probe,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) 	.remove = scm_remove,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) 	.handler = scm_blk_irq,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) int __init scm_drv_init(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) 	return scm_driver_register(&scm_drv);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) void scm_drv_cleanup(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92) 	scm_driver_unregister(&scm_drv);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) }