scm_drv.c 1.7 KB
Newer Older
S
Sebastian Ott 已提交
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90
/*
 * Device driver for s390 storage class memory.
 *
 * Copyright IBM Corp. 2012
 * Author(s): Sebastian Ott <sebott@linux.vnet.ibm.com>
 */

#define KMSG_COMPONENT "scm_block"
#define pr_fmt(fmt) KMSG_COMPONENT ": " fmt

#include <linux/module.h>
#include <linux/spinlock.h>
#include <linux/slab.h>
#include <asm/eadm.h>
#include "scm_blk.h"

static void notify(struct scm_device *scmdev)
{
	pr_info("%lu: The capabilities of the SCM increment changed\n",
		(unsigned long) scmdev->address);
	SCM_LOG(2, "State changed");
	SCM_LOG_STATE(2, scmdev);
}

static int scm_probe(struct scm_device *scmdev)
{
	struct scm_blk_dev *bdev;
	int ret;

	SCM_LOG(2, "probe");
	SCM_LOG_STATE(2, scmdev);

	if (scmdev->attrs.oper_state != OP_STATE_GOOD)
		return -EINVAL;

	bdev = kzalloc(sizeof(*bdev), GFP_KERNEL);
	if (!bdev)
		return -ENOMEM;

	spin_lock_irq(&scmdev->lock);
	dev_set_drvdata(&scmdev->dev, bdev);
	spin_unlock_irq(&scmdev->lock);

	ret = scm_blk_dev_setup(bdev, scmdev);
	if (ret) {
		spin_lock_irq(&scmdev->lock);
		dev_set_drvdata(&scmdev->dev, NULL);
		spin_unlock_irq(&scmdev->lock);
		kfree(bdev);
		goto out;
	}

out:
	return ret;
}

static int scm_remove(struct scm_device *scmdev)
{
	struct scm_blk_dev *bdev;

	spin_lock_irq(&scmdev->lock);
	bdev = dev_get_drvdata(&scmdev->dev);
	dev_set_drvdata(&scmdev->dev, NULL);
	spin_unlock_irq(&scmdev->lock);
	scm_blk_dev_cleanup(bdev);
	kfree(bdev);

	return 0;
}

static struct scm_driver scm_drv = {
	.drv = {
		.name = "scm_block",
		.owner = THIS_MODULE,
	},
	.notify = notify,
	.probe = scm_probe,
	.remove = scm_remove,
	.handler = scm_blk_irq,
};

int __init scm_drv_init(void)
{
	return scm_driver_register(&scm_drv);
}

void scm_drv_cleanup(void)
{
	scm_driver_unregister(&scm_drv);
}