[mirror_ubuntu-bionic-kernel.git] / arch / powerpc / sysdev / axonram.c

/*
 * (C) Copyright IBM Deutschland Entwicklung GmbH 2006
 *
 * Author: Maxim Shchetynin <maxim@de.ibm.com>
 *
 * Axon DDR2 device driver.
 * It registers one block device per Axon's DDR2 memory bank found on a system.
 * Block devices are called axonram?, their major and minor numbers are
 * available in /proc/devices, /proc/partitions or in /sys/block/axonram?/dev.
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2, or (at your option)
 * any later version.
 *
 * 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.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
 */

#include <linux/bio.h>
#include <linux/blkdev.h>
#include <linux/dax.h>
#include <linux/device.h>
#include <linux/errno.h>
#include <linux/fs.h>
#include <linux/genhd.h>
#include <linux/interrupt.h>
#include <linux/io.h>
#include <linux/ioport.h>
#include <linux/irq.h>
#include <linux/irqreturn.h>
#include <linux/kernel.h>
#include <linux/mm.h>
#include <linux/mod_devicetable.h>
#include <linux/module.h>
#include <linux/slab.h>
#include <linux/string.h>
#include <linux/types.h>
#include <linux/of_device.h>
#include <linux/of_platform.h>
#include <linux/pfn_t.h>
#include <linux/uio.h>

#include <asm/page.h>
#include <asm/prom.h>

#define AXON_RAM_MODULE_NAME		"axonram"
#define AXON_RAM_DEVICE_NAME		"axonram"
#define AXON_RAM_MINORS_PER_DISK	16
#define AXON_RAM_BLOCK_SHIFT		PAGE_SHIFT
#define AXON_RAM_BLOCK_SIZE		1 << AXON_RAM_BLOCK_SHIFT
#define AXON_RAM_SECTOR_SHIFT		9
#define AXON_RAM_SECTOR_SIZE		1 << AXON_RAM_SECTOR_SHIFT
#define AXON_RAM_IRQ_FLAGS		IRQF_SHARED | IRQF_TRIGGER_RISING

static int azfs_major, azfs_minor;

struct axon_ram_bank {
	struct platform_device	*device;
	struct gendisk		*disk;
	struct dax_device	*dax_dev;
	unsigned int		irq_id;
	unsigned long		ph_addr;
	unsigned long		io_addr;
	unsigned long		size;
	unsigned long		ecc_counter;
};

static ssize_t
axon_ram_sysfs_ecc(struct device *dev, struct device_attribute *attr, char *buf)
{
	struct platform_device *device = to_platform_device(dev);
	struct axon_ram_bank *bank = device->dev.platform_data;

	BUG_ON(!bank);

	return sprintf(buf, "%ld\n", bank->ecc_counter);
}

static DEVICE_ATTR(ecc, S_IRUGO, axon_ram_sysfs_ecc, NULL);

/**
 * axon_ram_irq_handler - interrupt handler for Axon RAM ECC
 * @irq: interrupt ID
 * @dev: pointer to of_device
 */
static irqreturn_t
axon_ram_irq_handler(int irq, void *dev)
{
	struct platform_device *device = dev;
	struct axon_ram_bank *bank = device->dev.platform_data;

	BUG_ON(!bank);

	dev_err(&device->dev, "Correctable memory error occurred\n");
	bank->ecc_counter++;
	return IRQ_HANDLED;
}

/**
 * axon_ram_make_request - make_request() method for block device
 * @queue, @bio: see blk_queue_make_request()
 */
static blk_qc_t
axon_ram_make_request(struct request_queue *queue, struct bio *bio)
{
	struct axon_ram_bank *bank = bio->bi_disk->private_data;
	unsigned long phys_mem, phys_end;
	void *user_mem;
	struct bio_vec vec;
	unsigned int transfered;
	struct bvec_iter iter;

	phys_mem = bank->io_addr + (bio->bi_iter.bi_sector <<
				    AXON_RAM_SECTOR_SHIFT);
	phys_end = bank->io_addr + bank->size;
	transfered = 0;
	bio_for_each_segment(vec, bio, iter) {
		if (unlikely(phys_mem + vec.bv_len > phys_end)) {
			bio_io_error(bio);
			return BLK_QC_T_NONE;
		}

		user_mem = page_address(vec.bv_page) + vec.bv_offset;
		if (bio_data_dir(bio) == READ)
			memcpy(user_mem, (void *) phys_mem, vec.bv_len);
		else
			memcpy((void *) phys_mem, user_mem, vec.bv_len);

		phys_mem += vec.bv_len;
		transfered += vec.bv_len;
	}
	bio_endio(bio);
	return BLK_QC_T_NONE;
}

static const struct block_device_operations axon_ram_devops = {
	.owner		= THIS_MODULE,
};

static long
__axon_ram_direct_access(struct axon_ram_bank *bank, pgoff_t pgoff, long nr_pages,
		       void **kaddr, pfn_t *pfn)
{
	resource_size_t offset = pgoff * PAGE_SIZE;

	*kaddr = (void *) bank->io_addr + offset;
	*pfn = phys_to_pfn_t(bank->ph_addr + offset, PFN_DEV);
	return (bank->size - offset) / PAGE_SIZE;
}

static long
axon_ram_dax_direct_access(struct dax_device *dax_dev, pgoff_t pgoff, long nr_pages,
		       void **kaddr, pfn_t *pfn)
{
	struct axon_ram_bank *bank = dax_get_private(dax_dev);

	return __axon_ram_direct_access(bank, pgoff, nr_pages, kaddr, pfn);
}

static size_t axon_ram_copy_from_iter(struct dax_device *dax_dev, pgoff_t pgoff,
		void *addr, size_t bytes, struct iov_iter *i)
{
	return copy_from_iter(addr, bytes, i);
}

static const struct dax_operations axon_ram_dax_ops = {
	.direct_access = axon_ram_dax_direct_access,
	.copy_from_iter = axon_ram_copy_from_iter,
};

/**
 * axon_ram_probe - probe() method for platform driver
 * @device: see platform_driver method
 */
static int axon_ram_probe(struct platform_device *device)
{
	static int axon_ram_bank_id = -1;
	struct axon_ram_bank *bank;
	struct resource resource;
	int rc = 0;

	axon_ram_bank_id++;

	dev_info(&device->dev, "Found memory controller on %pOF\n",
			device->dev.of_node);

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

	device->dev.platform_data = bank;

	bank->device = device;

	if (of_address_to_resource(device->dev.of_node, 0, &resource) != 0) {
		dev_err(&device->dev, "Cannot access device tree\n");
		rc = -EFAULT;
		goto failed;
	}

	bank->size = resource_size(&resource);

	if (bank->size == 0) {
		dev_err(&device->dev, "No DDR2 memory found for %s%d\n",
				AXON_RAM_DEVICE_NAME, axon_ram_bank_id);
		rc = -ENODEV;
		goto failed;
	}

	dev_info(&device->dev, "Register DDR2 memory device %s%d with %luMB\n",
			AXON_RAM_DEVICE_NAME, axon_ram_bank_id, bank->size >> 20);

	bank->ph_addr = resource.start;
	bank->io_addr = (unsigned long) ioremap_prot(
			bank->ph_addr, bank->size, _PAGE_NO_CACHE);
	if (bank->io_addr == 0) {
		dev_err(&device->dev, "ioremap() failed\n");
		rc = -EFAULT;
		goto failed;
	}

	bank->disk = alloc_disk(AXON_RAM_MINORS_PER_DISK);
	if (bank->disk == NULL) {
		dev_err(&device->dev, "Cannot register disk\n");
		rc = -EFAULT;
		goto failed;
	}


	bank->disk->major = azfs_major;
	bank->disk->first_minor = azfs_minor;
	bank->disk->fops = &axon_ram_devops;
	bank->disk->private_data = bank;

	sprintf(bank->disk->disk_name, "%s%d",
			AXON_RAM_DEVICE_NAME, axon_ram_bank_id);

	bank->dax_dev = alloc_dax(bank, bank->disk->disk_name,
			&axon_ram_dax_ops);
	if (!bank->dax_dev) {
		rc = -ENOMEM;
		goto failed;
	}

	bank->disk->queue = blk_alloc_queue(GFP_KERNEL);
	if (bank->disk->queue == NULL) {
		dev_err(&device->dev, "Cannot register disk queue\n");
		rc = -EFAULT;
		goto failed;
	}

	set_capacity(bank->disk, bank->size >> AXON_RAM_SECTOR_SHIFT);
	blk_queue_make_request(bank->disk->queue, axon_ram_make_request);
	blk_queue_logical_block_size(bank->disk->queue, AXON_RAM_SECTOR_SIZE);
	device_add_disk(&device->dev, bank->disk);

	bank->irq_id = irq_of_parse_and_map(device->dev.of_node, 0);
	if (!bank->irq_id) {
		dev_err(&device->dev, "Cannot access ECC interrupt ID\n");
		rc = -EFAULT;
		goto failed;
	}

	rc = request_irq(bank->irq_id, axon_ram_irq_handler,
			AXON_RAM_IRQ_FLAGS, bank->disk->disk_name, device);
	if (rc != 0) {
		dev_err(&device->dev, "Cannot register ECC interrupt handler\n");
		bank->irq_id = 0;
		rc = -EFAULT;
		goto failed;
	}

	rc = device_create_file(&device->dev, &dev_attr_ecc);
	if (rc != 0) {
		dev_err(&device->dev, "Cannot create sysfs file\n");
		rc = -EFAULT;
		goto failed;
	}

	azfs_minor += bank->disk->minors;

	return 0;

failed:
	if (bank->irq_id)
		free_irq(bank->irq_id, device);
	if (bank->disk != NULL) {
		if (bank->disk->major > 0)
			unregister_blkdev(bank->disk->major,
					bank->disk->disk_name);
		if (bank->disk->flags & GENHD_FL_UP)
			del_gendisk(bank->disk);
		put_disk(bank->disk);
	}
	kill_dax(bank->dax_dev);
	put_dax(bank->dax_dev);
	device->dev.platform_data = NULL;
	if (bank->io_addr != 0)
		iounmap((void __iomem *) bank->io_addr);
	kfree(bank);
	return rc;
}

/**
 * axon_ram_remove - remove() method for platform driver
 * @device: see of_platform_driver method
 */
static int
axon_ram_remove(struct platform_device *device)
{
	struct axon_ram_bank *bank = device->dev.platform_data;

	BUG_ON(!bank || !bank->disk);

	device_remove_file(&device->dev, &dev_attr_ecc);
	free_irq(bank->irq_id, device);
	kill_dax(bank->dax_dev);
	put_dax(bank->dax_dev);
	del_gendisk(bank->disk);
	put_disk(bank->disk);
	iounmap((void __iomem *) bank->io_addr);
	kfree(bank);

	return 0;
}

static const struct of_device_id axon_ram_device_id[] = {
	{
		.type	= "dma-memory"
	},
	{}
};
MODULE_DEVICE_TABLE(of, axon_ram_device_id);

static struct platform_driver axon_ram_driver = {
	.probe		= axon_ram_probe,
	.remove		= axon_ram_remove,
	.driver = {
		.name = AXON_RAM_MODULE_NAME,
		.of_match_table = axon_ram_device_id,
	},
};

/**
 * axon_ram_init
 */
static int __init
axon_ram_init(void)
{
	azfs_major = register_blkdev(azfs_major, AXON_RAM_DEVICE_NAME);
	if (azfs_major < 0) {
		printk(KERN_ERR "%s cannot become block device major number\n",
				AXON_RAM_MODULE_NAME);
		return -EFAULT;
	}
	azfs_minor = 0;

	return platform_driver_register(&axon_ram_driver);
}

/**
 * axon_ram_exit
 */
static void __exit
axon_ram_exit(void)
{
	platform_driver_unregister(&axon_ram_driver);
	unregister_blkdev(azfs_major, AXON_RAM_DEVICE_NAME);
}

module_init(axon_ram_init);
module_exit(axon_ram_exit);

MODULE_LICENSE("GPL");
MODULE_AUTHOR("Maxim Shchetynin <maxim@de.ibm.com>");
MODULE_DESCRIPTION("Axon DDR2 RAM device driver for IBM Cell BE");
Commit	Line	Data
dbdf04c4 MS	1	/*
	2	* (C) Copyright IBM Deutschland Entwicklung GmbH 2006
	3	*
	4	* Author: Maxim Shchetynin <maxim@de.ibm.com>
	5	*
	6	* Axon DDR2 device driver.
	7	* It registers one block device per Axon's DDR2 memory bank found on a system.
	8	* Block devices are called axonram?, their major and minor numbers are
	9	* available in /proc/devices, /proc/partitions or in /sys/block/axonram?/dev.
	10	*
	11	* This program is free software; you can redistribute it and/or modify
	12	* it under the terms of the GNU General Public License as published by
	13	* the Free Software Foundation; either version 2, or (at your option)
	14	* any later version.
	15	*
	16	* This program is distributed in the hope that it will be useful,
	17	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	18	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	19	* GNU General Public License for more details.
	20	*
	21	* You should have received a copy of the GNU General Public License
	22	* along with this program; if not, write to the Free Software
	23	* Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
	24	*/
	25
	26	#include <linux/bio.h>
	27	#include <linux/blkdev.h>
60fcd55c	28	#include <linux/dax.h>
dbdf04c4 MS	29	#include <linux/device.h>
	30	#include <linux/errno.h>
	31	#include <linux/fs.h>
	32	#include <linux/genhd.h>
	33	#include <linux/interrupt.h>
	34	#include <linux/io.h>
	35	#include <linux/ioport.h>
	36	#include <linux/irq.h>
	37	#include <linux/irqreturn.h>
	38	#include <linux/kernel.h>
	39	#include <linux/mm.h>
	40	#include <linux/mod_devicetable.h>
	41	#include <linux/module.h>
	42	#include <linux/slab.h>
	43	#include <linux/string.h>
	44	#include <linux/types.h>
eb8f2763 JL	45	#include <linux/of_device.h>
eb8f2763 JL	46	#include <linux/of_platform.h>
34c0fd54	47	#include <linux/pfn_t.h>
5d61e43b	48	#include <linux/uio.h>
eb8f2763	49
dbdf04c4 MS	50	#include <asm/page.h>
	51	#include <asm/prom.h>
	52
	53	#define AXON_RAM_MODULE_NAME "axonram"
	54	#define AXON_RAM_DEVICE_NAME "axonram"
	55	#define AXON_RAM_MINORS_PER_DISK 16
	56	#define AXON_RAM_BLOCK_SHIFT PAGE_SHIFT
	57	#define AXON_RAM_BLOCK_SIZE 1 << AXON_RAM_BLOCK_SHIFT
	58	#define AXON_RAM_SECTOR_SHIFT 9
	59	#define AXON_RAM_SECTOR_SIZE 1 << AXON_RAM_SECTOR_SHIFT
	60	#define AXON_RAM_IRQ_FLAGS IRQF_SHARED \| IRQF_TRIGGER_RISING
	61
9a23409b MS	62	static int azfs_major, azfs_minor;
9a23409b MS	63
dbdf04c4	64	struct axon_ram_bank {
a454dc50	65	struct platform_device *device;
dbdf04c4	66	struct gendisk *disk;
60fcd55c	67	struct dax_device *dax_dev;
fedcd2c5	68	unsigned int irq_id;
dbdf04c4 MS	69	unsigned long ph_addr;
	70	unsigned long io_addr;
	71	unsigned long size;
	72	unsigned long ecc_counter;
	73	};
	74
	75	static ssize_t
	76	axon_ram_sysfs_ecc(struct device dev, struct device_attribute attr, char *buf)
	77	{
a454dc50	78	struct platform_device *device = to_platform_device(dev);
dbdf04c4 MS	79	struct axon_ram_bank *bank = device->dev.platform_data;
	80
	81	BUG_ON(!bank);
	82
	83	return sprintf(buf, "%ld\n", bank->ecc_counter);
	84	}
	85
	86	static DEVICE_ATTR(ecc, S_IRUGO, axon_ram_sysfs_ecc, NULL);
	87
	88	/**
	89	* axon_ram_irq_handler - interrupt handler for Axon RAM ECC
	90	* @irq: interrupt ID
	91	* @dev: pointer to of_device
	92	*/
	93	static irqreturn_t
	94	axon_ram_irq_handler(int irq, void *dev)
	95	{
a454dc50	96	struct platform_device *device = dev;
dbdf04c4 MS	97	struct axon_ram_bank *bank = device->dev.platform_data;
	98
	99	BUG_ON(!bank);
	100
25985edc	101	dev_err(&device->dev, "Correctable memory error occurred\n");
fedcd2c5 MS	102	bank->ecc_counter++;
fedcd2c5 MS	103	return IRQ_HANDLED;
dbdf04c4 MS	104	}
	105
	106	/**
	107	* axon_ram_make_request - make_request() method for block device
	108	* @queue, @bio: see blk_queue_make_request()
	109	*/
dece1635	110	static blk_qc_t
dbdf04c4 MS	111	axon_ram_make_request(struct request_queue queue, struct bio bio)
dbdf04c4 MS	112	{
74d46992	113	struct axon_ram_bank *bank = bio->bi_disk->private_data;
dbdf04c4 MS	114	unsigned long phys_mem, phys_end;
dbdf04c4 MS	115	void *user_mem;
7988613b	116	struct bio_vec vec;
dbdf04c4	117	unsigned int transfered;
7988613b	118	struct bvec_iter iter;
dbdf04c4	119
4f024f37 KO	120	phys_mem = bank->io_addr + (bio->bi_iter.bi_sector <<
4f024f37 KO	121	AXON_RAM_SECTOR_SHIFT);
dbdf04c4 MS	122	phys_end = bank->io_addr + bank->size;
dbdf04c4 MS	123	transfered = 0;
7988613b KO	124	bio_for_each_segment(vec, bio, iter) {
7988613b KO	125	if (unlikely(phys_mem + vec.bv_len > phys_end)) {
d81fec0f	126	bio_io_error(bio);
dece1635	127	return BLK_QC_T_NONE;
dbdf04c4 MS	128	}
dbdf04c4 MS	129
7988613b	130	user_mem = page_address(vec.bv_page) + vec.bv_offset;
dbdf04c4	131	if (bio_data_dir(bio) == READ)
7988613b	132	memcpy(user_mem, (void *) phys_mem, vec.bv_len);
dbdf04c4	133	else
7988613b	134	memcpy((void *) phys_mem, user_mem, vec.bv_len);
dbdf04c4	135
7988613b KO	136	phys_mem += vec.bv_len;
7988613b KO	137	transfered += vec.bv_len;
dbdf04c4	138	}
4246a0b6	139	bio_endio(bio);
dece1635	140	return BLK_QC_T_NONE;
dbdf04c4 MS	141	}
dbdf04c4 MS	142
d4b29fd7 DW	143	static const struct block_device_operations axon_ram_devops = {
	144	.owner = THIS_MODULE,
	145	};
	146
60fcd55c DW	147	static long
	148	__axon_ram_direct_access(struct axon_ram_bank *bank, pgoff_t pgoff, long nr_pages,
	149	void *kaddr, pfn_t pfn)
	150	{
	151	resource_size_t offset = pgoff * PAGE_SIZE;
	152
	153	kaddr = (void ) bank->io_addr + offset;
	154	*pfn = phys_to_pfn_t(bank->ph_addr + offset, PFN_DEV);
	155	return (bank->size - offset) / PAGE_SIZE;
	156	}
	157
60fcd55c DW	158	static long
	159	axon_ram_dax_direct_access(struct dax_device *dax_dev, pgoff_t pgoff, long nr_pages,
	160	void *kaddr, pfn_t pfn)
	161	{
	162	struct axon_ram_bank *bank = dax_get_private(dax_dev);
	163
	164	return __axon_ram_direct_access(bank, pgoff, nr_pages, kaddr, pfn);
	165	}
	166
5d61e43b DW	167	static size_t axon_ram_copy_from_iter(struct dax_device *dax_dev, pgoff_t pgoff,
	168	void addr, size_t bytes, struct iov_iter i)
	169	{
	170	return copy_from_iter(addr, bytes, i);
	171	}
	172
60fcd55c DW	173	static const struct dax_operations axon_ram_dax_ops = {
60fcd55c DW	174	.direct_access = axon_ram_dax_direct_access,
5d61e43b	175	.copy_from_iter = axon_ram_copy_from_iter,
dbdf04c4 MS	176	};
	177
	178	/**
	179	* axon_ram_probe - probe() method for platform driver
00006124	180	* @device: see platform_driver method
dbdf04c4	181	*/
00006124	182	static int axon_ram_probe(struct platform_device *device)
dbdf04c4 MS	183	{
	184	static int axon_ram_bank_id = -1;
	185	struct axon_ram_bank *bank;
	186	struct resource resource;
	187	int rc = 0;
	188
	189	axon_ram_bank_id++;
	190
b7c670d6 RH	191	dev_info(&device->dev, "Found memory controller on %pOF\n",
b7c670d6 RH	192	device->dev.of_node);
dbdf04c4	193
a1bddf39	194	bank = kzalloc(sizeof(*bank), GFP_KERNEL);
fdbb9457 ME	195	if (!bank)
fdbb9457 ME	196	return -ENOMEM;
dbdf04c4 MS	197
	198	device->dev.platform_data = bank;
	199
	200	bank->device = device;
	201
61c7a080	202	if (of_address_to_resource(device->dev.of_node, 0, &resource) != 0) {
dbdf04c4 MS	203	dev_err(&device->dev, "Cannot access device tree\n");
	204	rc = -EFAULT;
	205	goto failed;
	206	}
	207
28f65c11	208	bank->size = resource_size(&resource);
dbdf04c4 MS	209
	210	if (bank->size == 0) {
	211	dev_err(&device->dev, "No DDR2 memory found for %s%d\n",
	212	AXON_RAM_DEVICE_NAME, axon_ram_bank_id);
	213	rc = -ENODEV;
	214	goto failed;
	215	}
	216
	217	dev_info(&device->dev, "Register DDR2 memory device %s%d with %luMB\n",
	218	AXON_RAM_DEVICE_NAME, axon_ram_bank_id, bank->size >> 20);
	219
	220	bank->ph_addr = resource.start;
40f1ce7f	221	bank->io_addr = (unsigned long) ioremap_prot(
dbdf04c4 MS	222	bank->ph_addr, bank->size, _PAGE_NO_CACHE);
	223	if (bank->io_addr == 0) {
	224	dev_err(&device->dev, "ioremap() failed\n");
	225	rc = -EFAULT;
	226	goto failed;
	227	}
	228
	229	bank->disk = alloc_disk(AXON_RAM_MINORS_PER_DISK);
	230	if (bank->disk == NULL) {
	231	dev_err(&device->dev, "Cannot register disk\n");
	232	rc = -EFAULT;
	233	goto failed;
	234	}
	235
60fcd55c	236
9a23409b MS	237	bank->disk->major = azfs_major;
9a23409b MS	238	bank->disk->first_minor = azfs_minor;
dbdf04c4 MS	239	bank->disk->fops = &axon_ram_devops;
dbdf04c4 MS	240	bank->disk->private_data = bank;
dbdf04c4 MS	241
	242	sprintf(bank->disk->disk_name, "%s%d",
	243	AXON_RAM_DEVICE_NAME, axon_ram_bank_id);
dbdf04c4	244
60fcd55c DW	245	bank->dax_dev = alloc_dax(bank, bank->disk->disk_name,
	246	&axon_ram_dax_ops);
	247	if (!bank->dax_dev) {
	248	rc = -ENOMEM;
	249	goto failed;
	250	}
	251
dbdf04c4 MS	252	bank->disk->queue = blk_alloc_queue(GFP_KERNEL);
	253	if (bank->disk->queue == NULL) {
	254	dev_err(&device->dev, "Cannot register disk queue\n");
	255	rc = -EFAULT;
	256	goto failed;
	257	}
	258
	259	set_capacity(bank->disk, bank->size >> AXON_RAM_SECTOR_SHIFT);
	260	blk_queue_make_request(bank->disk->queue, axon_ram_make_request);
e1defc4f	261	blk_queue_logical_block_size(bank->disk->queue, AXON_RAM_SECTOR_SIZE);
0d52c756	262	device_add_disk(&device->dev, bank->disk);
dbdf04c4	263
61c7a080	264	bank->irq_id = irq_of_parse_and_map(device->dev.of_node, 0);
ef24ba70	265	if (!bank->irq_id) {
dbdf04c4 MS	266	dev_err(&device->dev, "Cannot access ECC interrupt ID\n");
	267	rc = -EFAULT;
	268	goto failed;
	269	}
	270
fedcd2c5	271	rc = request_irq(bank->irq_id, axon_ram_irq_handler,
dbdf04c4 MS	272	AXON_RAM_IRQ_FLAGS, bank->disk->disk_name, device);
	273	if (rc != 0) {
	274	dev_err(&device->dev, "Cannot register ECC interrupt handler\n");
ef24ba70	275	bank->irq_id = 0;
dbdf04c4 MS	276	rc = -EFAULT;
	277	goto failed;
	278	}
	279
	280	rc = device_create_file(&device->dev, &dev_attr_ecc);
	281	if (rc != 0) {
	282	dev_err(&device->dev, "Cannot create sysfs file\n");
	283	rc = -EFAULT;
	284	goto failed;
	285	}
	286
9a23409b MS	287	azfs_minor += bank->disk->minors;
9a23409b MS	288
dbdf04c4 MS	289	return 0;
	290
	291	failed:
fdbb9457 ME	292	if (bank->irq_id)
	293	free_irq(bank->irq_id, device);
	294	if (bank->disk != NULL) {
	295	if (bank->disk->major > 0)
	296	unregister_blkdev(bank->disk->major,
	297	bank->disk->disk_name);
	298	if (bank->disk->flags & GENHD_FL_UP)
	299	del_gendisk(bank->disk);
	300	put_disk(bank->disk);
dbdf04c4	301	}
fdbb9457 ME	302	kill_dax(bank->dax_dev);
	303	put_dax(bank->dax_dev);
	304	device->dev.platform_data = NULL;
	305	if (bank->io_addr != 0)
	306	iounmap((void __iomem *) bank->io_addr);
	307	kfree(bank);
dbdf04c4 MS	308	return rc;
	309	}
	310
	311	/**
	312	* axon_ram_remove - remove() method for platform driver
	313	* @device: see of_platform_driver method
	314	*/
	315	static int
a454dc50	316	axon_ram_remove(struct platform_device *device)
dbdf04c4 MS	317	{
	318	struct axon_ram_bank *bank = device->dev.platform_data;
	319
	320	BUG_ON(!bank \|\| !bank->disk);
	321
	322	device_remove_file(&device->dev, &dev_attr_ecc);
fedcd2c5	323	free_irq(bank->irq_id, device);
60fcd55c DW	324	kill_dax(bank->dax_dev);
60fcd55c DW	325	put_dax(bank->dax_dev);
dbdf04c4	326	del_gendisk(bank->disk);
672a2c87	327	put_disk(bank->disk);
dbdf04c4 MS	328	iounmap((void __iomem *) bank->io_addr);
	329	kfree(bank);
	330
	331	return 0;
	332	}
	333
ce6d73c9	334	static const struct of_device_id axon_ram_device_id[] = {
dbdf04c4 MS	335	{
	336	.type = "dma-memory"
	337	},
	338	{}
	339	};
b4f81445	340	MODULE_DEVICE_TABLE(of, axon_ram_device_id);
dbdf04c4	341
00006124	342	static struct platform_driver axon_ram_driver = {
dbdf04c4	343	.probe = axon_ram_probe,
84dd4676	344	.remove = axon_ram_remove,
4018294b GL	345	.driver = {
4018294b GL	346	.name = AXON_RAM_MODULE_NAME,
4018294b	347	.of_match_table = axon_ram_device_id,
84dd4676	348	},
dbdf04c4 MS	349	};
	350
	351	/**
	352	* axon_ram_init
	353	*/
	354	static int __init
	355	axon_ram_init(void)
	356	{
9a23409b MS	357	azfs_major = register_blkdev(azfs_major, AXON_RAM_DEVICE_NAME);
	358	if (azfs_major < 0) {
	359	printk(KERN_ERR "%s cannot become block device major number\n",
	360	AXON_RAM_MODULE_NAME);
	361	return -EFAULT;
	362	}
	363	azfs_minor = 0;
	364
00006124	365	return platform_driver_register(&axon_ram_driver);
dbdf04c4 MS	366	}
	367
	368	/**
	369	* axon_ram_exit
	370	*/
	371	static void __exit
	372	axon_ram_exit(void)
	373	{
00006124	374	platform_driver_unregister(&axon_ram_driver);
9a23409b	375	unregister_blkdev(azfs_major, AXON_RAM_DEVICE_NAME);
dbdf04c4 MS	376	}
	377
	378	module_init(axon_ram_init);
	379	module_exit(axon_ram_exit);
	380
	381	MODULE_LICENSE("GPL");
	382	MODULE_AUTHOR("Maxim Shchetynin <maxim@de.ibm.com>");
	383	MODULE_DESCRIPTION("Axon DDR2 RAM device driver for IBM Cell BE");