mfd: Add Qualcomm PMIC 8921 core driver (cbdb53e1) · Commits · e / devices / android_kernel_oneplus_sm8150

drivers/mfd/Kconfig

+18 −0

Original line number	Diff line number	Diff line
		@@ -691,6 +691,24 @@ config MFD_OMAP_USB_HOST
		This MFD driver does the required setup functionalities for
		OMAP USB Host drivers.

		config MFD_PM8XXX
		tristate

		config MFD_PM8921_CORE
		tristate "Qualcomm PM8921 PMIC chip"
		depends on MSM_SSBI
		select MFD_CORE
		select MFD_PM8XXX
		help
		If you say yes to this option, support will be included for the
		built-in PM8921 PMIC chip.

		This is required if your board has a PM8921 and uses its features,
		such as: MPPs, GPIOs, regulators, interrupts, and PWM.

		Say M here if you want to include support for PM8921 chip as a module.
		This will build a module called "pm8921-core".

		endif # MFD_SUPPORT

		menu "Multimedia Capabilities Port drivers"

drivers/mfd/Makefile

+1 −0

Original line number	Diff line number	Diff line
		@@ -91,3 +91,4 @@ obj-$(CONFIG_MFD_VX855) += vx855.o
		obj-$(CONFIG_MFD_WL1273_CORE) += wl1273-core.o
		obj-$(CONFIG_MFD_CS5535) += cs5535-mfd.o
		obj-$(CONFIG_MFD_OMAP_USB_HOST) += omap-usb-host.o
		obj-$(CONFIG_MFD_PM8921_CORE) += pm8921-core.o

drivers/mfd/pm8921-core.c

0 → 100644

+158 −0

Original line number	Diff line number	Diff line
		/*
		* Copyright (c) 2011, Code Aurora Forum. All rights reserved.
		*
		* This program is free software; you can redistribute it and/or modify
		* it under the terms of the GNU General Public License version 2 and
		* only version 2 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.
		*/

		#define pr_fmt(fmt) "%s: " fmt, __func__

		#include <linux/kernel.h>
		#include <linux/platform_device.h>
		#include <linux/slab.h>
		#include <linux/msm_ssbi.h>
		#include <linux/mfd/core.h>
		#include <linux/mfd/pm8xxx/pm8921.h>
		#include <linux/mfd/pm8xxx/core.h>

		#define REG_HWREV 0x002 /* PMIC4 revision */
		#define REG_HWREV_2 0x0E8 /* PMIC4 revision 2 */

		struct pm8921 {
		struct device *dev;
		};

		static int pm8921_readb(const struct device dev, u16 addr, u8 val)
		{
		const struct pm8xxx_drvdata *pm8921_drvdata = dev_get_drvdata(dev);
		const struct pm8921 *pmic = pm8921_drvdata->pm_chip_data;

		return msm_ssbi_read(pmic->dev->parent, addr, val, 1);
		}

		static int pm8921_writeb(const struct device *dev, u16 addr, u8 val)
		{
		const struct pm8xxx_drvdata *pm8921_drvdata = dev_get_drvdata(dev);
		const struct pm8921 *pmic = pm8921_drvdata->pm_chip_data;

		return msm_ssbi_write(pmic->dev->parent, addr, &val, 1);
		}

		static int pm8921_read_buf(const struct device dev, u16 addr, u8 buf,
		int cnt)
		{
		const struct pm8xxx_drvdata *pm8921_drvdata = dev_get_drvdata(dev);
		const struct pm8921 *pmic = pm8921_drvdata->pm_chip_data;

		return msm_ssbi_read(pmic->dev->parent, addr, buf, cnt);
		}

		static int pm8921_write_buf(const struct device dev, u16 addr, u8 buf,
		int cnt)
		{
		const struct pm8xxx_drvdata *pm8921_drvdata = dev_get_drvdata(dev);
		const struct pm8921 *pmic = pm8921_drvdata->pm_chip_data;

		return msm_ssbi_write(pmic->dev->parent, addr, buf, cnt);
		}

		static struct pm8xxx_drvdata pm8921_drvdata = {
		.pmic_readb = pm8921_readb,
		.pmic_writeb = pm8921_writeb,
		.pmic_read_buf = pm8921_read_buf,
		.pmic_write_buf = pm8921_write_buf,
		};

		static int __devinit pm8921_probe(struct platform_device *pdev)
		{
		const struct pm8921_platform_data *pdata = pdev->dev.platform_data;
		struct pm8921 *pmic;
		int rc;
		u8 val;

		if (!pdata) {
		pr_err("missing platform data\n");
		return -EINVAL;
		}

		pmic = kzalloc(sizeof(struct pm8921), GFP_KERNEL);
		if (!pmic) {
		pr_err("Cannot alloc pm8921 struct\n");
		return -ENOMEM;
		}

		/* Read PMIC chip revision */
		rc = msm_ssbi_read(pdev->dev.parent, REG_HWREV, &val, sizeof(val));
		if (rc) {
		pr_err("Failed to read hw rev reg %d:rc=%d\n", REG_HWREV, rc);
		goto err_read_rev;
		}
		pr_info("PMIC revision 1: %02X\n", val);

		/* Read PMIC chip revision 2 */
		rc = msm_ssbi_read(pdev->dev.parent, REG_HWREV_2, &val, sizeof(val));
		if (rc) {
		pr_err("Failed to read hw rev 2 reg %d:rc=%d\n",
		REG_HWREV_2, rc);
		goto err_read_rev;
		}
		pr_info("PMIC revision 2: %02X\n", val);

		pmic->dev = &pdev->dev;
		pm8921_drvdata.pm_chip_data = pmic;
		platform_set_drvdata(pdev, &pm8921_drvdata);

		return 0;

		err_read_rev:
		kfree(pmic);
		return rc;
		}

		static int __devexit pm8921_remove(struct platform_device *pdev)
		{
		struct pm8xxx_drvdata *drvdata;
		struct pm8921 *pmic = NULL;

		drvdata = platform_get_drvdata(pdev);
		if (drvdata)
		pmic = drvdata->pm_chip_data;
		if (pmic)
		mfd_remove_devices(pmic->dev);
		platform_set_drvdata(pdev, NULL);
		kfree(pmic);

		return 0;
		}

		static struct platform_driver pm8921_driver = {
		.probe = pm8921_probe,
		.remove = __devexit_p(pm8921_remove),
		.driver = {
		.name = "pm8921-core",
		.owner = THIS_MODULE,
		},
		};

		static int __init pm8921_init(void)
		{
		return platform_driver_register(&pm8921_driver);
		}
		subsys_initcall(pm8921_init);

		static void __exit pm8921_exit(void)
		{
		platform_driver_unregister(&pm8921_driver);
		}
		module_exit(pm8921_exit);

		MODULE_LICENSE("GPL v2");
		MODULE_DESCRIPTION("PMIC 8921 core driver");
		MODULE_VERSION("1.0");
		MODULE_ALIAS("platform:pm8921-core");

include/linux/mfd/pm8xxx/core.h

0 → 100644

+71 −0

Original line number	Diff line number	Diff line
		/*
		* Copyright (c) 2011, Code Aurora Forum. All rights reserved.
		*
		* This program is free software; you can redistribute it and/or modify
		* it under the terms of the GNU General Public License version 2 and
		* only version 2 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.
		*/
		/*
		* Qualcomm PMIC 8xxx driver header file
		*
		*/

		#ifndef __MFD_PM8XXX_CORE_H
		#define __MFD_PM8XXX_CORE_H

		#include <linux/mfd/core.h>

		struct pm8xxx_drvdata {
		int (pmic_readb) (const struct device dev, u16 addr, u8 *val);
		int (pmic_writeb) (const struct device dev, u16 addr, u8 val);
		int (pmic_read_buf) (const struct device dev, u16 addr, u8 *buf,
		int n);
		int (pmic_write_buf) (const struct device dev, u16 addr, u8 *buf,
		int n);
		void *pm_chip_data;
		};

		static inline int pm8xxx_readb(const struct device dev, u16 addr, u8 val)
		{
		struct pm8xxx_drvdata *dd = dev_get_drvdata(dev);

		if (!dd)
		return -EINVAL;
		return dd->pmic_readb(dev, addr, val);
		}

		static inline int pm8xxx_writeb(const struct device *dev, u16 addr, u8 val)
		{
		struct pm8xxx_drvdata *dd = dev_get_drvdata(dev);

		if (!dd)
		return -EINVAL;
		return dd->pmic_writeb(dev, addr, val);
		}

		static inline int pm8xxx_read_buf(const struct device dev, u16 addr, u8 buf,
		int n)
		{
		struct pm8xxx_drvdata *dd = dev_get_drvdata(dev);

		if (!dd)
		return -EINVAL;
		return dd->pmic_read_buf(dev, addr, buf, n);
		}

		static inline int pm8xxx_write_buf(const struct device dev, u16 addr, u8 buf,
		int n)
		{
		struct pm8xxx_drvdata *dd = dev_get_drvdata(dev);

		if (!dd)
		return -EINVAL;
		return dd->pmic_write_buf(dev, addr, buf, n);
		}

		#endif

include/linux/mfd/pm8xxx/pm8921.h

0 → 100644

+27 −0

Original line number	Diff line number	Diff line
		/*
		* Copyright (c) 2011, Code Aurora Forum. All rights reserved.
		*
		* This program is free software; you can redistribute it and/or modify
		* it under the terms of the GNU General Public License version 2 and
		* only version 2 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.
		*/
		/*
		* Qualcomm PMIC 8921 driver header file
		*
		*/

		#ifndef __MFD_PM8921_H
		#define __MFD_PM8921_H

		#include <linux/device.h>

		struct pm8921_platform_data {
		int irq_base;
		};

		#endif