diff mbox

[4/5] Sound: Add FDT support to driver

Message ID 1352353039-17165-5-git-send-email-rajeshwari.s@samsung.com
State New
Headers show

Commit Message

Rajeshwari Shinde Nov. 8, 2012, 5:37 a.m. UTC
This patch adds FDT support to the driver.

Signed-off-by: Rajeshwari Shinde <rajeshwari.s@samsung.com>
---
 drivers/sound/sound.c |  228 +++++++++++++++++++++++++++++++++++++++++++++++--
 include/sound.h       |    9 ++
 2 files changed, 230 insertions(+), 7 deletions(-)

Comments

Simon Glass Nov. 9, 2012, 1:18 a.m. UTC | #1
Hi Rajeshwari,

On Wed, Nov 7, 2012 at 9:37 PM, Rajeshwari Shinde
<rajeshwari.s@samsung.com> wrote:
> This patch adds FDT support to the driver.
>
> Signed-off-by: Rajeshwari Shinde <rajeshwari.s@samsung.com>
> ---
>  drivers/sound/sound.c |  228 +++++++++++++++++++++++++++++++++++++++++++++++--
>  include/sound.h       |    9 ++
>  2 files changed, 230 insertions(+), 7 deletions(-)
>
> diff --git a/drivers/sound/sound.c b/drivers/sound/sound.c
> index 4c74534..3a845c9 100644
> --- a/drivers/sound/sound.c
> +++ b/drivers/sound/sound.c
> @@ -24,6 +24,8 @@
>  #include <malloc.h>
>  #include <common.h>
>  #include <asm/io.h>
> +#include <libfdt.h>
> +#include <fdtdec.h>
>  #include <i2c.h>
>  #include <i2s.h>
>  #include <sound.h>
> @@ -37,12 +39,225 @@
>  static struct i2stx_info g_i2stx_pri;
>  static struct sound_codec_info g_codec_info;
>
> +
> +#ifdef CONFIG_OF_CONTROL
>  /*
> - * get_sound_fdt_values gets fdt values for i2s parameters
> + * get_sound_i2s_fdt_values gets fdt values for i2s parameters
>   *
>   * @param i2stx_info   i2s transmitter transfer param structure
>   * @param blob         FDT blob
>   */
> +static int get_sound_i2s_fdt_values(struct i2stx_info *i2s, const void *blob)
> +{
> +       int node;
> +       int error = 0;
> +       int base;
> +
> +       node = fdtdec_next_compatible(blob, 0,
> +                                       COMPAT_SAMSUNG_EXYNOS5_SOUND);
> +       if (node <= 0) {
> +               debug("EXYNOS_SOUND: No node for sound in device tree\n");
> +               return -1;
> +       }
> +
> +       /*
> +        * Get the pre-defined sound specific values from FDT.
> +        * All of these are expected to be correct otherwise
> +        * wrong register values in i2s setup parameters
> +        * may result in no sound play.
> +        */
> +       base = fdtdec_get_addr(blob, node, "reg");
> +       if (base == FDT_ADDR_T_NONE) {
> +               debug("%s: Missing  i2s base\n", __func__);
> +               return -1;
> +       }
> +       i2s->base_address = base;
> +
> +       i2s->audio_pll_clk = fdtdec_get_int(blob,
> +                               node, "samsung,i2s-epll-clock-frequency", -1);
> +       error |= i2s->audio_pll_clk;
> +       debug("audio_pll_clk = %d\n", i2s->audio_pll_clk);
> +       i2s->samplingrate = fdtdec_get_int(blob,
> +                               node, "samsung,i2s-sampling-rate", -1);
> +       error |= i2s->samplingrate;
> +       debug("samplingrate = %d\n", i2s->samplingrate);
> +       i2s->bitspersample = fdtdec_get_int(blob,
> +                               node, "samsung,i2s-bits-per-sample", -1);
> +       error |= i2s->bitspersample;
> +       debug("bitspersample = %d\n", i2s->bitspersample);
> +       i2s->channels = fdtdec_get_int(blob,
> +                       node, "samsung,i2s-channels", -1);
> +       error |= i2s->channels;
> +       debug("channels = %d\n", i2s->channels);
> +       i2s->rfs = fdtdec_get_int(blob,
> +                               node, "samsung,i2s-lr-clk-framesize", -1);
> +       error |= i2s->rfs;
> +       debug("rfs = %d\n", i2s->rfs);
> +       i2s->bfs = fdtdec_get_int(blob,
> +                               node, "samsung,i2s-bit-clk-framesize", -1);
> +       error |= i2s->bfs;
> +       debug("bfs = %d\n", i2s->bfs);
> +       if (error == -1) {
> +               debug("fail to get sound i2s node properties\n");
> +               return -1;
> +       }
> +
> +       return 0;
> +}
> +
> +/*
> + * Gets fdt values for wm8994 config parameters

Should not mention the particular codec here - this driver should work with any.

> + *
> + * @param pcodec_info  codec information structure
> + * @param blob         FDT blob
> + * @return             int value, 0 for success
> + */
> +static int get_sound_fdt_values(struct sound_codec_info *pcodec_info,
> +                       const void *blob, enum fdt_compat_id compat_id)
> +{
> +       enum fdt_compat_id compat;
> +       int node;
> +       int error = 0;
> +       int parent;
> +
> +       /* Get the node from FDT for codec */
> +       node = fdtdec_next_compatible(blob, 0, compat_id);
> +       if (node <= 0) {
> +               debug("EXYNOS_SOUND: No node for codec in device tree\n");
> +               debug("node = %d\n", node);
> +               return -1;
> +       }
> +
> +       parent = fdt_parent_offset(blob, node);
> +       if (parent < 0) {
> +               debug("%s: Cannot find node parent\n", __func__);
> +               return -1;
> +       }
> +
> +       compat = fdtdec_lookup(blob, parent);
> +       switch (compat) {
> +       case COMPAT_SAMSUNG_EXYNOS_SPI:
> +               debug("%s: Support not added for SPI interface\n", __func__);
> +               return -1;
> +               break;

Perhaps just punt this spi code then?

> +       case COMPAT_SAMSUNG_S3C2440_I2C:
> +               pcodec_info->i2c_bus = i2c_get_bus_num_fdt(blob, parent);
> +               error |= pcodec_info->i2c_bus;
> +               debug("i2c bus = %d\n", pcodec_info->i2c_bus);
> +               pcodec_info->i2c_dev_addr = fdtdec_get_int(blob, node,
> +                                                               "reg", 0);
> +               error |= pcodec_info->i2c_dev_addr;
> +               debug("i2c dev addr = %d\n", pcodec_info->i2c_dev_addr);
> +               break;
> +       default:
> +               debug("%s: Unknown compat id %d\n", __func__, compat);
> +               return -1;
> +       }
> +
> +       if (error == -1) {
> +               debug("fail to get codec node properties\n");
> +               return -1;
> +       }
> +
> +       return 0;
> +}
> +
> +/*
> + * Gets fdt values for codec config parameters
> + *
> + * @param pcodec_info   codec information structure
> + * @param blob          FDT blob
> + * @return              int value, 0 for success
> + */
> +static int get_sound_codec_fdt_values(struct sound_codec_info *pcodec_info,
> +                                                       const void *blob)
> +{
> +       int node;
> +       int error = 0;
> +       const char *codectype;
> +
> +       /* Get the node from FDT for sound */
> +       node = fdtdec_next_compatible(blob, 0, COMPAT_SAMSUNG_EXYNOS5_SOUND);
> +       if (node <= 0) {
> +               debug("EXYNOS_SOUND: No node for sound in device tree\n");
> +               debug("node = %d\n", node);
> +               return -1;
> +       }
> +
> +       /*
> +        * Get the pre-defined sound codec specific values from FDT.
> +        * All of these are expected to be correct otherwise sound
> +        * can not be played
> +        */
> +       codectype = fdt_getprop(blob, node, "samsung,codec-type", NULL);
> +       debug("device = %s\n", codectype);
> +
> +       if (!strcmp(codectype, "wm8994")) {
> +               pcodec_info->codec_type = CODEC_WM_8994;
> +               error = get_sound_fdt_values(pcodec_info, blob,
> +                                               COMPAT_WOLFSON_WM8994_CODEC);
> +       } else {
> +               error = -1;
> +       }

As mentioned I think this code should move into the wm8994 driver.
You can just look for the compatible string there.

> +
> +       if (error == -1) {
> +               debug("fail to get sound codec node properties\n");
> +               return -1;
> +       }
> +
> +       return 0;
> +}
> +
> +int sound_init(const void *blob)
> +{
> +       int ret;
> +       struct i2stx_info *pi2s_tx = &g_i2stx_pri;
> +       struct sound_codec_info *pcodec_info = &g_codec_info;
> +
> +       /* Get the I2S Values */
> +       if (get_sound_i2s_fdt_values(pi2s_tx, blob) < 0) {
> +               debug(" FDT I2S values failed\n");
> +               return -1;
> +       }
> +
> +       /* Get the codec Values */
> +       if (get_sound_codec_fdt_values(pcodec_info, blob) < 0) {
> +               debug("FDT Codec values failed\n");
> +               return -1;
> +       }
> +
> +       ret = i2s_tx_init(pi2s_tx);
> +       if (ret) {
> +               debug("%s: Failed to init i2c transmit: ret=%d\n", __func__,
> +                     ret);
> +               return ret;
> +       }
> +
> +       /* Check the codec type and initialise the same */
> +       if (pcodec_info->codec_type == CODEC_WM_8994) {
> +               ret = wm8994_init(pcodec_info, WM8994_AIF2,
> +                       pi2s_tx->samplingrate,
> +                       (pi2s_tx->samplingrate * (pi2s_tx->rfs)),
> +                       pi2s_tx->bitspersample, pi2s_tx->channels);

Perhaps the wm8994 driver should call sound_init() and pass a
structure containing its functions for codec setup, etc. as needed?
Seems better than calling out to different codecs in the generic sound
driver.

> +       } else {
> +               debug("%s: Unknown code type %d\n", __func__,
> +                     pcodec_info->codec_type);
> +               return -1;
> +       }
> +       if (ret) {
> +               debug("%s: Codec init failed\n", __func__);
> +               return -1;
> +       }
> +
> +       return ret;
> +}
> +
> +#else
> +/*
> + * get_sound_values gets values for i2s parameters
> + *
> + * @param i2stx_info   i2s transmitter transfer param structure
> + */
>  static void get_sound_i2s_values(struct i2stx_info *i2s)
>  {
>         i2s->base_address = samsung_get_base_i2s();
> @@ -55,13 +270,12 @@ static void get_sound_i2s_values(struct i2stx_info *i2s)
>  }
>
>  /*
> - * Gets fdt values for wm8994 config parameters
> + * Gets values for wm8994 config parameters
>   *
>   * @param pcodec_info  codec information structure
> - * @param blob         FDT blob
>   * @return             int value, 0 for success
>   */
> -static int get_sound_wm8994_values(struct sound_codec_info *pcodec_info)
> +static int get_sound_values(struct sound_codec_info *pcodec_info)
>  {
>         int error = 0;
>
> @@ -89,10 +303,9 @@ static int get_sound_wm8994_values(struct sound_codec_info *pcodec_info)
>  }
>
>  /*
> - * Gets fdt values for codec config parameters
> + * Gets values for codec config parameters
>   *
>   * @param pcodec_info  codec information structure
> - * @param blob         FDT blob
>   * @return             int value, 0 for success
>   */
>  static int get_sound_codec_values(struct sound_codec_info *pcodec_info)
> @@ -104,7 +317,7 @@ static int get_sound_codec_values(struct sound_codec_info *pcodec_info)
>
>         if (!strcmp(codectype, "wm8994")) {
>                 pcodec_info->codec_type = CODEC_WM_8994;
> -               error = get_sound_wm8994_values(pcodec_info);
> +               error = get_sound_values(pcodec_info);
>         } else {
>                 error = -1;
>         }
> @@ -155,6 +368,7 @@ int sound_init(void)
>
>         return ret;
>  }
> +#endif
>
>  /*
>   * Generates square wave sound data for 1 second
> diff --git a/include/sound.h b/include/sound.h
> index ea0b115..aeb70ee 100644
> --- a/include/sound.h
> +++ b/include/sound.h
> @@ -44,12 +44,21 @@ struct sound_codec_info {
>         enum en_sound_codec codec_type;
>  };
>
> +#ifdef CONFIG_OF_CONTROL
> +/*
> + * Initialises audio sub system
> + * @param blob Pointer of device tree node.
> + * @return     int value 0 for success, -1 for error
> + */
> +int sound_init(const void *blob);
> +#else

This is a bit ugly - you can just pass the blob even if
CONFIG_OF_CONTROL is not set. It will be NULL. That avoids two
function signatures.

>  /*
>   * Initialises audio sub system
>   *
>   * @return     int value 0 for success, -1 for error
>   */
>  int sound_init(void);
> +#endif
>
>  /*
>   * plays the pcm data buffer in pcm_data.h through i2s1 to make the
> --
> 1.7.4.4
>

Regards,
Simon
diff mbox

Patch

diff --git a/drivers/sound/sound.c b/drivers/sound/sound.c
index 4c74534..3a845c9 100644
--- a/drivers/sound/sound.c
+++ b/drivers/sound/sound.c
@@ -24,6 +24,8 @@ 
 #include <malloc.h>
 #include <common.h>
 #include <asm/io.h>
+#include <libfdt.h>
+#include <fdtdec.h>
 #include <i2c.h>
 #include <i2s.h>
 #include <sound.h>
@@ -37,12 +39,225 @@ 
 static struct i2stx_info g_i2stx_pri;
 static struct sound_codec_info g_codec_info;
 
+
+#ifdef CONFIG_OF_CONTROL
 /*
- * get_sound_fdt_values gets fdt values for i2s parameters
+ * get_sound_i2s_fdt_values gets fdt values for i2s parameters
  *
  * @param i2stx_info	i2s transmitter transfer param structure
  * @param blob		FDT blob
  */
+static int get_sound_i2s_fdt_values(struct i2stx_info *i2s, const void *blob)
+{
+	int node;
+	int error = 0;
+	int base;
+
+	node = fdtdec_next_compatible(blob, 0,
+					COMPAT_SAMSUNG_EXYNOS5_SOUND);
+	if (node <= 0) {
+		debug("EXYNOS_SOUND: No node for sound in device tree\n");
+		return -1;
+	}
+
+	/*
+	 * Get the pre-defined sound specific values from FDT.
+	 * All of these are expected to be correct otherwise
+	 * wrong register values in i2s setup parameters
+	 * may result in no sound play.
+	 */
+	base = fdtdec_get_addr(blob, node, "reg");
+	if (base == FDT_ADDR_T_NONE) {
+		debug("%s: Missing  i2s base\n", __func__);
+		return -1;
+	}
+	i2s->base_address = base;
+
+	i2s->audio_pll_clk = fdtdec_get_int(blob,
+				node, "samsung,i2s-epll-clock-frequency", -1);
+	error |= i2s->audio_pll_clk;
+	debug("audio_pll_clk = %d\n", i2s->audio_pll_clk);
+	i2s->samplingrate = fdtdec_get_int(blob,
+				node, "samsung,i2s-sampling-rate", -1);
+	error |= i2s->samplingrate;
+	debug("samplingrate = %d\n", i2s->samplingrate);
+	i2s->bitspersample = fdtdec_get_int(blob,
+				node, "samsung,i2s-bits-per-sample", -1);
+	error |= i2s->bitspersample;
+	debug("bitspersample = %d\n", i2s->bitspersample);
+	i2s->channels = fdtdec_get_int(blob,
+			node, "samsung,i2s-channels", -1);
+	error |= i2s->channels;
+	debug("channels = %d\n", i2s->channels);
+	i2s->rfs = fdtdec_get_int(blob,
+				node, "samsung,i2s-lr-clk-framesize", -1);
+	error |= i2s->rfs;
+	debug("rfs = %d\n", i2s->rfs);
+	i2s->bfs = fdtdec_get_int(blob,
+				node, "samsung,i2s-bit-clk-framesize", -1);
+	error |= i2s->bfs;
+	debug("bfs = %d\n", i2s->bfs);
+	if (error == -1) {
+		debug("fail to get sound i2s node properties\n");
+		return -1;
+	}
+
+	return 0;
+}
+
+/*
+ * Gets fdt values for wm8994 config parameters
+ *
+ * @param pcodec_info	codec information structure
+ * @param blob		FDT blob
+ * @return		int value, 0 for success
+ */
+static int get_sound_fdt_values(struct sound_codec_info *pcodec_info,
+			const void *blob, enum fdt_compat_id compat_id)
+{
+	enum fdt_compat_id compat;
+	int node;
+	int error = 0;
+	int parent;
+
+	/* Get the node from FDT for codec */
+	node = fdtdec_next_compatible(blob, 0, compat_id);
+	if (node <= 0) {
+		debug("EXYNOS_SOUND: No node for codec in device tree\n");
+		debug("node = %d\n", node);
+		return -1;
+	}
+
+	parent = fdt_parent_offset(blob, node);
+	if (parent < 0) {
+		debug("%s: Cannot find node parent\n", __func__);
+		return -1;
+	}
+
+	compat = fdtdec_lookup(blob, parent);
+	switch (compat) {
+	case COMPAT_SAMSUNG_EXYNOS_SPI:
+		debug("%s: Support not added for SPI interface\n", __func__);
+		return -1;
+		break;
+	case COMPAT_SAMSUNG_S3C2440_I2C:
+		pcodec_info->i2c_bus = i2c_get_bus_num_fdt(blob, parent);
+		error |= pcodec_info->i2c_bus;
+		debug("i2c bus = %d\n", pcodec_info->i2c_bus);
+		pcodec_info->i2c_dev_addr = fdtdec_get_int(blob, node,
+								"reg", 0);
+		error |= pcodec_info->i2c_dev_addr;
+		debug("i2c dev addr = %d\n", pcodec_info->i2c_dev_addr);
+		break;
+	default:
+		debug("%s: Unknown compat id %d\n", __func__, compat);
+		return -1;
+	}
+
+	if (error == -1) {
+		debug("fail to get codec node properties\n");
+		return -1;
+	}
+
+	return 0;
+}
+
+/*
+ * Gets fdt values for codec config parameters
+ *
+ * @param pcodec_info   codec information structure
+ * @param blob          FDT blob
+ * @return              int value, 0 for success
+ */
+static int get_sound_codec_fdt_values(struct sound_codec_info *pcodec_info,
+							const void *blob)
+{
+	int node;
+	int error = 0;
+	const char *codectype;
+
+	/* Get the node from FDT for sound */
+	node = fdtdec_next_compatible(blob, 0, COMPAT_SAMSUNG_EXYNOS5_SOUND);
+	if (node <= 0) {
+		debug("EXYNOS_SOUND: No node for sound in device tree\n");
+		debug("node = %d\n", node);
+		return -1;
+	}
+
+	/*
+	 * Get the pre-defined sound codec specific values from FDT.
+	 * All of these are expected to be correct otherwise sound
+	 * can not be played
+	 */
+	codectype = fdt_getprop(blob, node, "samsung,codec-type", NULL);
+	debug("device = %s\n", codectype);
+
+	if (!strcmp(codectype, "wm8994")) {
+		pcodec_info->codec_type = CODEC_WM_8994;
+		error = get_sound_fdt_values(pcodec_info, blob,
+						COMPAT_WOLFSON_WM8994_CODEC);
+	} else {
+		error = -1;
+	}
+
+	if (error == -1) {
+		debug("fail to get sound codec node properties\n");
+		return -1;
+	}
+
+	return 0;
+}
+
+int sound_init(const void *blob)
+{
+	int ret;
+	struct i2stx_info *pi2s_tx = &g_i2stx_pri;
+	struct sound_codec_info *pcodec_info = &g_codec_info;
+
+	/* Get the I2S Values */
+	if (get_sound_i2s_fdt_values(pi2s_tx, blob) < 0) {
+		debug(" FDT I2S values failed\n");
+		return -1;
+	}
+
+	/* Get the codec Values */
+	if (get_sound_codec_fdt_values(pcodec_info, blob) < 0) {
+		debug("FDT Codec values failed\n");
+		return -1;
+	}
+
+	ret = i2s_tx_init(pi2s_tx);
+	if (ret) {
+		debug("%s: Failed to init i2c transmit: ret=%d\n", __func__,
+		      ret);
+		return ret;
+	}
+
+	/* Check the codec type and initialise the same */
+	if (pcodec_info->codec_type == CODEC_WM_8994) {
+		ret = wm8994_init(pcodec_info, WM8994_AIF2,
+			pi2s_tx->samplingrate,
+			(pi2s_tx->samplingrate * (pi2s_tx->rfs)),
+			pi2s_tx->bitspersample, pi2s_tx->channels);
+	} else {
+		debug("%s: Unknown code type %d\n", __func__,
+		      pcodec_info->codec_type);
+		return -1;
+	}
+	if (ret) {
+		debug("%s: Codec init failed\n", __func__);
+		return -1;
+	}
+
+	return ret;
+}
+
+#else
+/*
+ * get_sound_values gets values for i2s parameters
+ *
+ * @param i2stx_info	i2s transmitter transfer param structure
+ */
 static void get_sound_i2s_values(struct i2stx_info *i2s)
 {
 	i2s->base_address = samsung_get_base_i2s();
@@ -55,13 +270,12 @@  static void get_sound_i2s_values(struct i2stx_info *i2s)
 }
 
 /*
- * Gets fdt values for wm8994 config parameters
+ * Gets values for wm8994 config parameters
  *
  * @param pcodec_info	codec information structure
- * @param blob		FDT blob
  * @return		int value, 0 for success
  */
-static int get_sound_wm8994_values(struct sound_codec_info *pcodec_info)
+static int get_sound_values(struct sound_codec_info *pcodec_info)
 {
 	int error = 0;
 
@@ -89,10 +303,9 @@  static int get_sound_wm8994_values(struct sound_codec_info *pcodec_info)
 }
 
 /*
- * Gets fdt values for codec config parameters
+ * Gets values for codec config parameters
  *
  * @param pcodec_info	codec information structure
- * @param blob		FDT blob
  * @return		int value, 0 for success
  */
 static int get_sound_codec_values(struct sound_codec_info *pcodec_info)
@@ -104,7 +317,7 @@  static int get_sound_codec_values(struct sound_codec_info *pcodec_info)
 
 	if (!strcmp(codectype, "wm8994")) {
 		pcodec_info->codec_type = CODEC_WM_8994;
-		error = get_sound_wm8994_values(pcodec_info);
+		error = get_sound_values(pcodec_info);
 	} else {
 		error = -1;
 	}
@@ -155,6 +368,7 @@  int sound_init(void)
 
 	return ret;
 }
+#endif
 
 /*
  * Generates square wave sound data for 1 second
diff --git a/include/sound.h b/include/sound.h
index ea0b115..aeb70ee 100644
--- a/include/sound.h
+++ b/include/sound.h
@@ -44,12 +44,21 @@  struct sound_codec_info {
 	enum en_sound_codec codec_type;
 };
 
+#ifdef CONFIG_OF_CONTROL
+/*
+ * Initialises audio sub system
+ * @param blob	Pointer of device tree node.
+ * @return	int value 0 for success, -1 for error
+ */
+int sound_init(const void *blob);
+#else
 /*
  * Initialises audio sub system
  *
  * @return	int value 0 for success, -1 for error
  */
 int sound_init(void);
+#endif
 
 /*
  * plays the pcm data buffer in pcm_data.h through i2s1 to make the