[2/2] ASoC: rt5645: set platform data base on DMI

Commit Message

[e-mail] April 23, 2015, 11:35 p.m. UTC

From: "Fang, Yang A" <[e-mail]>

set platform specific data for intel strago platform

Signed-off-by: Fang, Yang A <[e-mail]>
---
 sound/soc/codecs/rt5645.c |   51 ++++++++++++++++++++++++++++++++++++++++++++-
 1 file changed, 50 insertions(+), 1 deletion(-)

Comments

Mark Brown April 24, 2015, 10:12 a.m. UTC | #1

On Thu, Apr 23, 2015 at 04:35:18PM -0700, [e-mail] wrote:

> +static int strago_quirk_cb(const struct dmi_system_id *id)
> +{
> +	struct rt5645_priv **rt5645;
> +
> +	rt5645 = (struct rt5645_priv **)id->driver_data;
> +
> +	if (*rt5645) {
> +
> +		(*rt5645)->pdata.dmic_en = 1;
> +		(*rt5645)->pdata.dmic1_data_pin = -1;
> +		(*rt5645)->pdata.dmic2_data_pin = RT5645_DMIC_DATA_IN2P;
> +		(*rt5645)->pdata.en_jd_func = 1;
> +		(*rt5645)->pdata.jd_mode = 3;
> +
> +	}
> +
> +	return 1;
> +}

This doesn't look good - we're modifying the driver data which should
really be global static data.  I'd expect us to be doing something like
return a pointer to the platform data for the device, not modify things
in place.

Patch

diff --git a/sound/soc/codecs/rt5645.c b/sound/soc/codecs/rt5645.c
index e16724a..14cabee 100644
--- a/sound/soc/codecs/rt5645.c
+++ b/sound/soc/codecs/rt5645.c
@@ -19,6 +19,7 @@ 
 #include <linux/spi/spi.h>
 #include <linux/gpio.h>
 #include <linux/acpi.h>
+#include <linux/dmi.h>
 #include <sound/core.h>
 #include <sound/pcm.h>
 #include <sound/pcm_params.h>
@@ -2628,6 +2629,39 @@  static struct acpi_device_id rt5645_acpi_match[] = {
 MODULE_DEVICE_TABLE(acpi, rt5645_acpi_match);
 #endif
 
+static struct rt5645_priv *grt5645;
+
+static int strago_quirk_cb(const struct dmi_system_id *id)
+{
+	struct rt5645_priv **rt5645;
+
+	rt5645 = (struct rt5645_priv **)id->driver_data;
+
+	if (*rt5645) {
+
+		(*rt5645)->pdata.dmic_en = 1;
+		(*rt5645)->pdata.dmic1_data_pin = -1;
+		(*rt5645)->pdata.dmic2_data_pin = RT5645_DMIC_DATA_IN2P;
+		(*rt5645)->pdata.en_jd_func = 1;
+		(*rt5645)->pdata.jd_mode = 3;
+
+	}
+
+	return 1;
+}
+
+static struct dmi_system_id dmi_platform_intel_braswell[] __initdata = {
+	{
+		.ident = "Intel Strago",
+		.callback = strago_quirk_cb,
+		.matches = {
+			DMI_MATCH(DMI_PRODUCT_NAME, "Strago"),
+		},
+		.driver_data = (void *)&grt5645,
+	},
+	{ }
+};
+
 static int rt5645_i2c_probe(struct i2c_client *i2c,
 		    const struct i2c_device_id *id)
 {
@@ -2635,17 +2669,32 @@  static int rt5645_i2c_probe(struct i2c_client *i2c,
 	struct rt5645_priv *rt5645;
 	int ret;
 	unsigned int val;
+	struct gpio_desc *gpiod;
 
 	rt5645 = devm_kzalloc(&i2c->dev, sizeof(struct rt5645_priv),
 				GFP_KERNEL);
 	if (rt5645 == NULL)
 		return -ENOMEM;
 
+	grt5645 = rt5645;
 	rt5645->i2c = i2c;
 	i2c_set_clientdata(i2c, rt5645);
 
-	if (pdata)
+	if (pdata) {
 		rt5645->pdata = *pdata;
+	} else {
+		dmi_check_system(dmi_platform_intel_braswell);
+		gpiod = devm_gpiod_get_index(&i2c->dev, "rt5645", 0);
+
+		if (IS_ERR(gpiod) || gpiod_direction_input(gpiod)) {
+			rt5645->pdata.hp_det_gpio = -1;
+			dev_err(&i2c->dev, "failed to initialize gpiod\n");
+		} else {
+			rt5645->pdata.hp_det_gpio = desc_to_gpio(gpiod);
+			rt5645->pdata.gpio_hp_det_active_high
+						= !gpiod_is_active_low(gpiod);
+		}
+	}
 
 	rt5645->regmap = devm_regmap_init_i2c(i2c, &rt5645_regmap);
 	if (IS_ERR(rt5645->regmap)) {