[ARM] 5127/1: Core MFD support (aa613de6) · Commits · 戴 / test

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

Admin message