mfd: wcd934x: Add support to wcd9340/wcd9341 codec (6ac7e4d7) · Commits · 戴 / test

drivers/mfd/Kconfig

+12 −0

Original line number	Diff line number	Diff line
		@@ -1976,6 +1976,18 @@ config MFD_STMFX
		additional drivers must be enabled in order to use the functionality
		of the device.

		config MFD_WCD934X
		tristate "Support for WCD9340/WCD9341 Codec"
		depends on SLIMBUS
		select REGMAP
		select REGMAP_SLIMBUS
		select REGMAP_IRQ
		select MFD_CORE
		help
		Support for the Qualcomm WCD9340/WCD9341 Codec.
		This driver provides common support WCD934x audio codec and its
		associated Pin Controller, Soundwire Controller and Audio codec.

		menu "Multimedia Capabilities Port drivers"
		depends on ARCH_SA1100

drivers/mfd/Makefile

+1 −0

Original line number	Diff line number	Diff line
		@@ -58,6 +58,7 @@ endif
		ifeq ($(CONFIG_MFD_CS47L24),y)
		obj-$(CONFIG_MFD_ARIZONA) += cs47l24-tables.o
		endif
		obj-$(CONFIG_MFD_WCD934X) += wcd934x.o
		obj-$(CONFIG_MFD_WM8400) += wm8400-core.o
		wm831x-objs := wm831x-core.o wm831x-irq.o wm831x-otp.o
		wm831x-objs += wm831x-auxadc.o

drivers/mfd/wcd934x.c

0 → 100644

+306 −0

Original line number	Diff line number	Diff line
		// SPDX-License-Identifier: GPL-2.0
		// Copyright (c) 2019, Linaro Limited

		#include <linux/clk.h>
		#include <linux/gpio.h>
		#include <linux/interrupt.h>
		#include <linux/kernel.h>
		#include <linux/mfd/core.h>
		#include <linux/mfd/wcd934x/registers.h>
		#include <linux/mfd/wcd934x/wcd934x.h>
		#include <linux/module.h>
		#include <linux/of_gpio.h>
		#include <linux/of.h>
		#include <linux/of_irq.h>
		#include <linux/platform_device.h>
		#include <linux/regmap.h>
		#include <linux/regulator/consumer.h>
		#include <linux/slimbus.h>

		static const struct mfd_cell wcd934x_devices[] = {
		{
		.name = "wcd934x-codec",
		}, {
		.name = "wcd934x-gpio",
		.of_compatible = "qcom,wcd9340-gpio",
		}, {
		.name = "wcd934x-soundwire",
		.of_compatible = "qcom,soundwire-v1.3.0",
		},
		};

		static const struct regmap_irq wcd934x_irqs[] = {
		[WCD934X_IRQ_SLIMBUS] = {
		.reg_offset = 0,
		.mask = BIT(0),
		.type = {
		.type_reg_offset = 0,
		.types_supported = IRQ_TYPE_EDGE_BOTH,
		.type_reg_mask = BIT(0),
		.type_level_low_val = BIT(0),
		.type_level_high_val = BIT(0),
		.type_falling_val = 0,
		.type_rising_val = 0,
		},
		},
		[WCD934X_IRQ_SOUNDWIRE] = {
		.reg_offset = 2,
		.mask = BIT(4),
		.type = {
		.type_reg_offset = 2,
		.types_supported = IRQ_TYPE_EDGE_BOTH,
		.type_reg_mask = BIT(4),
		.type_level_low_val = BIT(4),
		.type_level_high_val = BIT(4),
		.type_falling_val = 0,
		.type_rising_val = 0,
		},
		},
		};

		static const struct regmap_irq_chip wcd934x_regmap_irq_chip = {
		.name = "wcd934x_irq",
		.status_base = WCD934X_INTR_PIN1_STATUS0,
		.mask_base = WCD934X_INTR_PIN1_MASK0,
		.ack_base = WCD934X_INTR_PIN1_CLEAR0,
		.type_base = WCD934X_INTR_LEVEL0,
		.num_type_reg = 4,
		.type_in_mask = false,
		.num_regs = 4,
		.irqs = wcd934x_irqs,
		.num_irqs = ARRAY_SIZE(wcd934x_irqs),
		};

		static bool wcd934x_is_volatile_register(struct device *dev, unsigned int reg)
		{
		switch (reg) {
		case WCD934X_INTR_PIN1_STATUS0...WCD934X_INTR_PIN2_CLEAR3:
		case WCD934X_SWR_AHB_BRIDGE_RD_DATA_0:
		case WCD934X_SWR_AHB_BRIDGE_RD_DATA_1:
		case WCD934X_SWR_AHB_BRIDGE_RD_DATA_2:
		case WCD934X_SWR_AHB_BRIDGE_RD_DATA_3:
		case WCD934X_SWR_AHB_BRIDGE_ACCESS_STATUS:
		case WCD934X_ANA_MBHC_RESULT_3:
		case WCD934X_ANA_MBHC_RESULT_2:
		case WCD934X_ANA_MBHC_RESULT_1:
		case WCD934X_ANA_MBHC_MECH:
		case WCD934X_ANA_MBHC_ELECT:
		case WCD934X_ANA_MBHC_ZDET:
		case WCD934X_ANA_MICB2:
		case WCD934X_ANA_RCO:
		case WCD934X_ANA_BIAS:
		return true;
		default:
		return false;
		}
		};

		static const struct regmap_range_cfg wcd934x_ranges[] = {
		{ .name = "WCD934X",
		.range_min = 0x0,
		.range_max = WCD934X_MAX_REGISTER,
		.selector_reg = WCD934X_SEL_REGISTER,
		.selector_mask = WCD934X_SEL_MASK,
		.selector_shift = WCD934X_SEL_SHIFT,
		.window_start = WCD934X_WINDOW_START,
		.window_len = WCD934X_WINDOW_LENGTH,
		},
		};

		static struct regmap_config wcd934x_regmap_config = {
		.reg_bits = 16,
		.val_bits = 8,
		.cache_type = REGCACHE_RBTREE,
		.max_register = 0xffff,
		.can_multi_write = true,
		.ranges = wcd934x_ranges,
		.num_ranges = ARRAY_SIZE(wcd934x_ranges),
		.volatile_reg = wcd934x_is_volatile_register,
		};

		static int wcd934x_bring_up(struct wcd934x_ddata *ddata)
		{
		struct regmap *regmap = ddata->regmap;
		u16 id_minor, id_major;
		int ret;

		ret = regmap_bulk_read(regmap, WCD934X_CHIP_TIER_CTRL_CHIP_ID_BYTE0,
		(u8 *)&id_minor, sizeof(u16));
		if (ret)
		return ret;

		ret = regmap_bulk_read(regmap, WCD934X_CHIP_TIER_CTRL_CHIP_ID_BYTE2,
		(u8 *)&id_major, sizeof(u16));
		if (ret)
		return ret;

		dev_info(ddata->dev, "WCD934x chip id major 0x%x, minor 0x%x\n",
		id_major, id_minor);

		regmap_write(regmap, WCD934X_CODEC_RPM_RST_CTL, 0x01);
		regmap_write(regmap, WCD934X_SIDO_NEW_VOUT_A_STARTUP, 0x19);
		regmap_write(regmap, WCD934X_SIDO_NEW_VOUT_D_STARTUP, 0x15);
		/* Add 1msec delay for VOUT to settle */
		usleep_range(1000, 1100);
		regmap_write(regmap, WCD934X_CODEC_RPM_PWR_CDC_DIG_HM_CTL, 0x5);
		regmap_write(regmap, WCD934X_CODEC_RPM_PWR_CDC_DIG_HM_CTL, 0x7);
		regmap_write(regmap, WCD934X_CODEC_RPM_RST_CTL, 0x3);
		regmap_write(regmap, WCD934X_CODEC_RPM_RST_CTL, 0x7);
		regmap_write(regmap, WCD934X_CODEC_RPM_PWR_CDC_DIG_HM_CTL, 0x3);

		return 0;
		}

		static int wcd934x_slim_status_up(struct slim_device *sdev)
		{
		struct device *dev = &sdev->dev;
		struct wcd934x_ddata *ddata;
		int ret;

		ddata = dev_get_drvdata(dev);

		ddata->regmap = regmap_init_slimbus(sdev, &wcd934x_regmap_config);
		if (IS_ERR(ddata->regmap)) {
		dev_err(dev, "Error allocating slim regmap\n");
		return PTR_ERR(ddata->regmap);
		}

		ret = wcd934x_bring_up(ddata);
		if (ret) {
		dev_err(dev, "Failed to bring up WCD934X: err = %d\n", ret);
		return ret;
		}

		ret = devm_regmap_add_irq_chip(dev, ddata->regmap, ddata->irq,
		IRQF_TRIGGER_HIGH, 0,
		&wcd934x_regmap_irq_chip,
		&ddata->irq_data);
		if (ret) {
		dev_err(dev, "Failed to add IRQ chip: err = %d\n", ret);
		return ret;
		}

		ret = mfd_add_devices(dev, PLATFORM_DEVID_AUTO, wcd934x_devices,
		ARRAY_SIZE(wcd934x_devices), NULL, 0, NULL);
		if (ret) {
		dev_err(dev, "Failed to add child devices: err = %d\n",
		ret);
		return ret;
		}

		return ret;
		}

		static int wcd934x_slim_status(struct slim_device *sdev,
		enum slim_device_status status)
		{
		switch (status) {
		case SLIM_DEVICE_STATUS_UP:
		return wcd934x_slim_status_up(sdev);
		case SLIM_DEVICE_STATUS_DOWN:
		mfd_remove_devices(&sdev->dev);
		break;
		default:
		return -EINVAL;
		}

		return 0;
		}

		static int wcd934x_slim_probe(struct slim_device *sdev)
		{
		struct device *dev = &sdev->dev;
		struct device_node *np = dev->of_node;
		struct wcd934x_ddata *ddata;
		int reset_gpio, ret;

		ddata = devm_kzalloc(dev, sizeof(*ddata), GFP_KERNEL);
		if (!ddata)
		return -ENOMEM;

		ddata->irq = of_irq_get(np, 0);
		if (ddata->irq < 0) {
		if (ddata->irq != -EPROBE_DEFER)
		dev_err(ddata->dev, "Failed to get IRQ: err = %d\n",
		ddata->irq);
		return ddata->irq;
		}

		reset_gpio = of_get_named_gpio(np, "reset-gpios", 0);
		if (reset_gpio < 0) {
		dev_err(dev, "Failed to get reset gpio: err = %d\n",
		reset_gpio);
		return reset_gpio;
		}

		ddata->extclk = devm_clk_get(dev, "extclk");
		if (IS_ERR(ddata->extclk)) {
		dev_err(dev, "Failed to get extclk");
		return PTR_ERR(ddata->extclk);
		}

		ddata->supplies[0].supply = "vdd-buck";
		ddata->supplies[1].supply = "vdd-buck-sido";
		ddata->supplies[2].supply = "vdd-tx";
		ddata->supplies[3].supply = "vdd-rx";
		ddata->supplies[4].supply = "vdd-io";

		ret = regulator_bulk_get(dev, WCD934X_MAX_SUPPLY, ddata->supplies);
		if (ret) {
		dev_err(dev, "Failed to get supplies: err = %d\n", ret);
		return ret;
		}

		ret = regulator_bulk_enable(WCD934X_MAX_SUPPLY, ddata->supplies);
		if (ret) {
		dev_err(dev, "Failed to enable supplies: err = %d\n", ret);
		return ret;
		}

		/*
		* For WCD934X, it takes about 600us for the Vout_A and
		* Vout_D to be ready after BUCK_SIDO is powered up.
		* SYS_RST_N shouldn't be pulled high during this time
		*/
		usleep_range(600, 650);
		gpio_direction_output(reset_gpio, 0);
		msleep(20);
		gpio_set_value(reset_gpio, 1);
		msleep(20);

		ddata->dev = dev;
		dev_set_drvdata(dev, ddata);

		return 0;
		}

		static void wcd934x_slim_remove(struct slim_device *sdev)
		{
		struct wcd934x_ddata *ddata = dev_get_drvdata(&sdev->dev);

		regulator_bulk_disable(WCD934X_MAX_SUPPLY, ddata->supplies);
		mfd_remove_devices(&sdev->dev);
		kfree(ddata);
		}

		static const struct slim_device_id wcd934x_slim_id[] = {
		{ SLIM_MANF_ID_QCOM, SLIM_PROD_CODE_WCD9340,
		SLIM_DEV_IDX_WCD9340, SLIM_DEV_INSTANCE_ID_WCD9340 },
		{}
		};

		static struct slim_driver wcd934x_slim_driver = {
		.driver = {
		.name = "wcd934x-slim",
		},
		.probe = wcd934x_slim_probe,
		.remove = wcd934x_slim_remove,
		.device_status = wcd934x_slim_status,
		.id_table = wcd934x_slim_id,
		};

		module_slim_driver(wcd934x_slim_driver);
		MODULE_DESCRIPTION("WCD934X slim driver");
		MODULE_LICENSE("GPL v2");
		MODULE_ALIAS("slim:217:250:*");
		MODULE_AUTHOR("Srinivas Kandagatla <srinivas.kandagatla@linaro.org>");

include/linux/mfd/wcd934x/registers.h

0 → 100644

+531 −0

File added.

Preview size limit exceeded, changes collapsed.

include/linux/mfd/wcd934x/wcd934x.h

0 → 100644

+31 −0

Original line number	Diff line number	Diff line
		/* SPDX-License-Identifier: GPL-2.0 */

		#ifndef __WCD934X_H__
		#define __WCD934X_H__
		#include <linux/clk.h>
		#include <linux/regulator/consumer.h>
		#include <linux/regmap.h>
		#include <linux/slimbus.h>

		#define WCD934X_MAX_SUPPLY 5

		/**
		* struct wcd934x_ddata - wcd934x driver data
		*
		* @supplies: wcd934x regulator supplies
		* @irq_data: wcd934x irq_chip data
		* @regmap: wcd934x regmap pointer
		* @extclk: External clock
		* @dev: device instance of wcd934x slim device
		* @irq: irq for wcd934x.
		*/
		struct wcd934x_ddata {
		struct regulator_bulk_data supplies[WCD934X_MAX_SUPPLY];
		struct regmap_irq_chip_data *irq_data;
		struct regmap *regmap;
		struct clk *extclk;
		struct device *dev;
		int irq;
		};

		#endif /* __WCD934X_H__ */

Admin message