Commit aa613de6 authored by Dmitry Eremin-Solenikov's avatar Dmitry Eremin-Solenikov Committed by Russell King
Browse files

[ARM] 5127/1: Core MFD support 



This patch provides a common subdevice registration system for MFD type
chips, using platfrom device.

Signed-off-by: default avatarIan Molton <spyro@f2s.com>
Signed-off-by: default avatarDmitry Baryshkov <dbaryshkov@gmail.com>
Signed-off-by: default avatarRussell King <rmk+kernel@arm.linux.org.uk>
parent 53b14ea3

drivers/mfd/Kconfig

+4 −0
Original line number Diff line number Diff line
@@ -5,6 +5,10 @@ 
menu "Multifunction device drivers"

	depends on HAS_IOMEM



config MFD_CORE

	tristate

	default n



config MFD_SM501

	tristate "Support for Silicon Motion SM501"

	 ---help---

drivers/mfd/Makefile

+2 −0
Original line number Diff line number Diff line
@@ -10,6 +10,8 @@ obj-$(CONFIG_HTC_PASIC3) += htc-pasic3.o 


obj-$(CONFIG_MFD_TC6393XB)	+= tc6393xb.o



obj-$(CONFIG_MFD_CORE)		+= mfd-core.o



obj-$(CONFIG_MCP)		+= mcp-core.o

obj-$(CONFIG_MCP_SA11X0)	+= mcp-sa11x0.o

obj-$(CONFIG_MCP_UCB1200)	+= ucb1x00-core.o

drivers/mfd/mfd-core.c

0 → 100644
+114 −0
Original line number Diff line number Diff line 
/*

 * drivers/mfd/mfd-core.c

 *

 * core MFD support

 * Copyright (c) 2006 Ian Molton

 * Copyright (c) 2007,2008 Dmitry Baryshkov

 *

 * This program is free software; you can redistribute it and/or modify

 * it under the terms of the GNU General Public License version 2 as

 * published by the Free Software Foundation.

 *

 */



#include <linux/kernel.h>

#include <linux/platform_device.h>

#include <linux/mfd/core.h>



static int mfd_add_device(struct platform_device *parent,

		const struct mfd_cell *cell,

		struct resource *mem_base,

		int irq_base)

{

	struct resource res[cell->num_resources];

	struct platform_device *pdev;

	int ret = -ENOMEM;

	int r;



	pdev = platform_device_alloc(cell->name, parent->id);

	if (!pdev)

		goto fail_alloc;



	pdev->dev.parent = &parent->dev;



	ret = platform_device_add_data(pdev,

			cell, sizeof(struct mfd_cell));

	if (ret)

		goto fail_device;



	memzero(res, sizeof(res));

	for (r = 0; r < cell->num_resources; r++) {

		res[r].name = cell->resources[r].name;

		res[r].flags = cell->resources[r].flags;



		/* Find out base to use */

		if (cell->resources[r].flags & IORESOURCE_MEM) {

			res[r].parent = mem_base;

			res[r].start = mem_base->start +

				cell->resources[r].start;

			res[r].end = mem_base->start +

				cell->resources[r].end;

		} else if (cell->resources[r].flags & IORESOURCE_IRQ) {

			res[r].start = irq_base +

				cell->resources[r].start;

			res[r].end   = irq_base +

				cell->resources[r].end;

		} else {

			res[r].parent = cell->resources[r].parent;

			res[r].start = cell->resources[r].start;

			res[r].end   = cell->resources[r].end;

		}

	}



	platform_device_add_resources(pdev, res, cell->num_resources);



	ret = platform_device_add(pdev);

	if (ret)

		goto fail_device;



	return 0;



/*	platform_device_del(pdev); */

fail_device:

	platform_device_put(pdev);

fail_alloc:

	return ret;

}



int mfd_add_devices(

		struct platform_device *parent,

		const struct mfd_cell *cells, int n_devs,

		struct resource *mem_base,

		int irq_base)

{

	int i;

	int ret = 0;



	for (i = 0; i < n_devs; i++) {

		ret = mfd_add_device(parent, cells + i, mem_base, irq_base);

		if (ret)

			break;

	}



	if (ret)

		mfd_remove_devices(parent);



	return ret;

}

EXPORT_SYMBOL(mfd_add_devices);



static int mfd_remove_devices_fn(struct device *dev, void *unused)

{

	platform_device_unregister(

			container_of(dev, struct platform_device, dev));

	return 0;

}



void mfd_remove_devices(struct platform_device *parent)

{

	device_for_each_child(&parent->dev, NULL, mfd_remove_devices_fn);

}

EXPORT_SYMBOL(mfd_remove_devices);



MODULE_LICENSE("GPL");

MODULE_AUTHOR("Ian Molton, Dmitry Baryshkov");

include/linux/mfd/core.h

0 → 100644
+55 −0
Original line number Diff line number Diff line 
#ifndef MFD_CORE_H

#define MFD_CORE_H

/*

 * drivers/mfd/mfd-core.h

 *

 * core MFD support

 * Copyright (c) 2006 Ian Molton

 * Copyright (c) 2007 Dmitry Baryshkov

 *

 * This program is free software; you can redistribute it and/or modify

 * it under the terms of the GNU General Public License version 2 as

 * published by the Free Software Foundation.

 *

 */



#include <linux/platform_device.h>



/*

 * This struct describes the MFD part ("cell").

 * After registration the copy of this structure will become the platform data

 * of the resulting platform_device

 */

struct mfd_cell {

	const char		*name;



	int			(*enable)(struct platform_device *dev);

	int			(*disable)(struct platform_device *dev);

	int			(*suspend)(struct platform_device *dev);

	int			(*resume)(struct platform_device *dev);



	void			*driver_data; /* driver-specific data */



	/*

	 * This resources can be specified relatievly to the parent device.

	 * For accessing device you should use resources from device

	 */

	int			num_resources;

	const struct resource	*resources;

};



static inline struct mfd_cell *

mfd_get_cell(struct platform_device *pdev)

{

	return (struct mfd_cell *)pdev->dev.platform_data;

}



extern int mfd_add_devices(

		struct platform_device *parent,

		const struct mfd_cell *cells, int n_devs,

		struct resource *mem_base,

		int irq_base);



extern void mfd_remove_devices(struct platform_device *parent);



#endif