[linux-2.6-block.git] / drivers / nvdimm / dimm.c

/*
 * Copyright(c) 2013-2015 Intel Corporation. All rights reserved.
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of version 2 of the GNU General Public License as
 * published by the Free Software Foundation.
 *
 * This program is distributed in the hope that it will be useful, but
 * WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 * General Public License for more details.
 */
#include <linux/vmalloc.h>
#include <linux/module.h>
#include <linux/device.h>
#include <linux/sizes.h>
#include <linux/ndctl.h>
#include <linux/slab.h>
#include <linux/mm.h>
#include <linux/nd.h>
#include "label.h"
#include "nd.h"

static int nvdimm_probe(struct device *dev)
{
	struct nvdimm_drvdata *ndd;
	int rc;

	rc = nvdimm_check_config_data(dev);
	if (rc) {
		/* not required for non-aliased nvdimm, ex. NVDIMM-N */
		if (rc == -ENOTTY)
			rc = 0;
		return rc;
	}

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

	dev_set_drvdata(dev, ndd);
	ndd->dpa.name = dev_name(dev);
	ndd->ns_current = -1;
	ndd->ns_next = -1;
	ndd->dpa.start = 0;
	ndd->dpa.end = -1;
	ndd->dev = dev;
	get_device(dev);
	kref_init(&ndd->kref);

	rc = nvdimm_init_nsarea(ndd);
	if (rc == -EACCES)
		nvdimm_set_locked(dev);
	if (rc)
		goto err;

	rc = nvdimm_init_config_data(ndd);
	if (rc == -EACCES)
		nvdimm_set_locked(dev);
	if (rc)
		goto err;

	dev_dbg(dev, "config data size: %d\n", ndd->nsarea.config_size);

	nvdimm_bus_lock(dev);
	ndd->ns_current = nd_label_validate(ndd);
	ndd->ns_next = nd_label_next_nsindex(ndd->ns_current);
	nd_label_copy(ndd, to_next_namespace_index(ndd),
			to_current_namespace_index(ndd));
	rc = nd_label_reserve_dpa(ndd);
	if (ndd->ns_current >= 0)
		nvdimm_set_aliasing(dev);
	nvdimm_clear_locked(dev);
	nvdimm_bus_unlock(dev);

	if (rc)
		goto err;

	return 0;

 err:
	put_ndd(ndd);
	return rc;
}

static int nvdimm_remove(struct device *dev)
{
	struct nvdimm_drvdata *ndd = dev_get_drvdata(dev);

	if (!ndd)
		return 0;

	nvdimm_bus_lock(dev);
	dev_set_drvdata(dev, NULL);
	nvdimm_bus_unlock(dev);
	put_ndd(ndd);

	return 0;
}

static struct nd_device_driver nvdimm_driver = {
	.probe = nvdimm_probe,
	.remove = nvdimm_remove,
	.drv = {
		.name = "nvdimm",
	},
	.type = ND_DRIVER_DIMM,
};

int __init nvdimm_init(void)
{
	return nd_driver_register(&nvdimm_driver);
}

void nvdimm_exit(void)
{
	driver_unregister(&nvdimm_driver.drv);
}

MODULE_ALIAS_ND_DEVICE(ND_DEVICE_DIMM);
Commit	Line	Data
4d88a97a DW	1	/*
	2	* Copyright(c) 2013-2015 Intel Corporation. All rights reserved.
	3	*
	4	* This program is free software; you can redistribute it and/or modify
	5	* it under the terms of version 2 of the GNU General Public License as
	6	* published by the Free Software Foundation.
	7	*
	8	* This program is distributed in the hope that it will be useful, but
	9	* WITHOUT ANY WARRANTY; without even the implied warranty of
	10	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
	11	* General Public License for more details.
	12	*/
	13	#include <linux/vmalloc.h>
	14	#include <linux/module.h>
	15	#include <linux/device.h>
	16	#include <linux/sizes.h>
	17	#include <linux/ndctl.h>
	18	#include <linux/slab.h>
	19	#include <linux/mm.h>
	20	#include <linux/nd.h>
4a826c83	21	#include "label.h"
4d88a97a DW	22	#include "nd.h"
4d88a97a DW	23
4d88a97a DW	24	static int nvdimm_probe(struct device *dev)
	25	{
	26	struct nvdimm_drvdata *ndd;
	27	int rc;
	28
aee65987 TK	29	rc = nvdimm_check_config_data(dev);
	30	if (rc) {
	31	/* not required for non-aliased nvdimm, ex. NVDIMM-N */
	32	if (rc == -ENOTTY)
	33	rc = 0;
	34	return rc;
	35	}
	36
4d88a97a DW	37	ndd = kzalloc(sizeof(*ndd), GFP_KERNEL);
	38	if (!ndd)
	39	return -ENOMEM;
	40
	41	dev_set_drvdata(dev, ndd);
4a826c83 DW	42	ndd->dpa.name = dev_name(dev);
	43	ndd->ns_current = -1;
	44	ndd->ns_next = -1;
	45	ndd->dpa.start = 0;
	46	ndd->dpa.end = -1;
4d88a97a	47	ndd->dev = dev;
bf9bccc1 DW	48	get_device(dev);
bf9bccc1 DW	49	kref_init(&ndd->kref);
4d88a97a DW	50
4d88a97a DW	51	rc = nvdimm_init_nsarea(ndd);
9d62ed96 DW	52	if (rc == -EACCES)
9d62ed96 DW	53	nvdimm_set_locked(dev);
4d88a97a DW	54	if (rc)
	55	goto err;
	56
	57	rc = nvdimm_init_config_data(ndd);
4b27db7e DW	58	if (rc == -EACCES)
4b27db7e DW	59	nvdimm_set_locked(dev);
4d88a97a DW	60	if (rc)
	61	goto err;
	62
	63	dev_dbg(dev, "config data size: %d\n", ndd->nsarea.config_size);
	64
4a826c83 DW	65	nvdimm_bus_lock(dev);
	66	ndd->ns_current = nd_label_validate(ndd);
	67	ndd->ns_next = nd_label_next_nsindex(ndd->ns_current);
	68	nd_label_copy(ndd, to_next_namespace_index(ndd),
	69	to_current_namespace_index(ndd));
	70	rc = nd_label_reserve_dpa(ndd);
42237e39 DW	71	if (ndd->ns_current >= 0)
42237e39 DW	72	nvdimm_set_aliasing(dev);
d34cb808	73	nvdimm_clear_locked(dev);
4a826c83 DW	74	nvdimm_bus_unlock(dev);
	75
	76	if (rc)
	77	goto err;
	78
4d88a97a DW	79	return 0;
	80
	81	err:
bf9bccc1	82	put_ndd(ndd);
4d88a97a DW	83	return rc;
	84	}
	85
	86	static int nvdimm_remove(struct device *dev)
	87	{
	88	struct nvdimm_drvdata *ndd = dev_get_drvdata(dev);
	89
aee65987 TK	90	if (!ndd)
	91	return 0;
	92
4a826c83 DW	93	nvdimm_bus_lock(dev);
4a826c83 DW	94	dev_set_drvdata(dev, NULL);
4a826c83	95	nvdimm_bus_unlock(dev);
bf9bccc1	96	put_ndd(ndd);
4d88a97a DW	97
	98	return 0;
	99	}
	100
	101	static struct nd_device_driver nvdimm_driver = {
	102	.probe = nvdimm_probe,
	103	.remove = nvdimm_remove,
	104	.drv = {
	105	.name = "nvdimm",
	106	},
	107	.type = ND_DRIVER_DIMM,
	108	};
	109
	110	int __init nvdimm_init(void)
	111	{
	112	return nd_driver_register(&nvdimm_driver);
	113	}
	114
3d88002e	115	void nvdimm_exit(void)
4d88a97a DW	116	{
	117	driver_unregister(&nvdimm_driver.drv);
	118	}
	119
	120	MODULE_ALIAS_ND_DEVICE(ND_DEVICE_DIMM);