drivers/sound/sound.c

   1 /*
   2  * Copyright (C) 2012 Samsung Electronics
   3  * R. Chandrasekar <rcsekar@samsung.com>
   4  *
   5  * SPDX-License-Identifier:     GPL-2.0+
   6  */
   7
   8 #include <malloc.h>
   9 #include <common.h>
  10 #include <asm/io.h>
  11 #include <libfdt.h>
  12 #include <fdtdec.h>
  13 #include <i2c.h>
  14 #include <i2s.h>
  15 #include <sound.h>
  16 #include <asm/arch/sound.h>
  17 #include "wm8994.h"
  18 #include "max98095.h"
  19
  20 /* defines */
  21 #define SOUND_400_HZ 400
  22 #define SOUND_BITS_IN_BYTE 8
  23
  24 static struct i2stx_info g_i2stx_pri;
  25
  26 /*
  27  * get_sound_i2s_values gets values for i2s parameters
  28  *
  29  * @param i2stx_info    i2s transmitter transfer param structure
  30  * @param blob          FDT blob if enabled else NULL
  31  */
  32 static int get_sound_i2s_values(struct i2stx_info *i2s, const void *blob)
  33 {
  34 #ifdef CONFIG_OF_CONTROL
  35         int node;
  36         int error = 0;
  37         int base;
  38
  39         node = fdt_path_offset(blob, "i2s");
  40         if (node <= 0) {
  41                 debug("EXYNOS_SOUND: No node for sound in device tree\n");
  42                 return -1;
  43         }
  44
  45         /*
  46          * Get the pre-defined sound specific values from FDT.
  47          * All of these are expected to be correct otherwise
  48          * wrong register values in i2s setup parameters
  49          * may result in no sound play.
  50          */
  51         base = fdtdec_get_addr(blob, node, "reg");
  52         if (base == FDT_ADDR_T_NONE) {
  53                 debug("%s: Missing  i2s base\n", __func__);
  54                 return -1;
  55         }
  56         i2s->base_address = base;
  57
  58         i2s->audio_pll_clk = fdtdec_get_int(blob,
  59                                 node, "samsung,i2s-epll-clock-frequency", -1);
  60         error |= i2s->audio_pll_clk;
  61         debug("audio_pll_clk = %d\n", i2s->audio_pll_clk);
  62         i2s->samplingrate = fdtdec_get_int(blob,
  63                                 node, "samsung,i2s-sampling-rate", -1);
  64         error |= i2s->samplingrate;
  65         debug("samplingrate = %d\n", i2s->samplingrate);
  66         i2s->bitspersample = fdtdec_get_int(blob,
  67                                 node, "samsung,i2s-bits-per-sample", -1);
  68         error |= i2s->bitspersample;
  69         debug("bitspersample = %d\n", i2s->bitspersample);
  70         i2s->channels = fdtdec_get_int(blob,
  71                         node, "samsung,i2s-channels", -1);
  72         error |= i2s->channels;
  73         debug("channels = %d\n", i2s->channels);
  74         i2s->rfs = fdtdec_get_int(blob,
  75                                 node, "samsung,i2s-lr-clk-framesize", -1);
  76         error |= i2s->rfs;
  77         debug("rfs = %d\n", i2s->rfs);
  78         i2s->bfs = fdtdec_get_int(blob,
  79                                 node, "samsung,i2s-bit-clk-framesize", -1);
  80         error |= i2s->bfs;
  81         debug("bfs = %d\n", i2s->bfs);
  82
  83         i2s->id = fdtdec_get_int(blob, node, "samsung,i2s-id", -1);
  84         error |= i2s->id;
  85         debug("id = %d\n", i2s->id);
  86
  87         if (error == -1) {
  88                 debug("fail to get sound i2s node properties\n");
  89                 return -1;
  90         }
  91 #else
  92         i2s->base_address = samsung_get_base_i2s();
  93         i2s->audio_pll_clk = I2S_PLL_CLK;
  94         i2s->samplingrate = I2S_SAMPLING_RATE;
  95         i2s->bitspersample = I2S_BITS_PER_SAMPLE;
  96         i2s->channels = I2S_CHANNELS;
  97         i2s->rfs = I2S_RFS;
  98         i2s->bfs = I2S_BFS;
  99         i2s->id = 0;
 100 #endif
 101         return 0;
 102 }
 103
 104 /*
 105  * Init codec
 106  *
 107  * @param blob          FDT blob
 108  * @param pi2s_tx       i2s parameters required by codec
 109  * @return              int value, 0 for success
 110  */
 111 static int codec_init(const void *blob, struct i2stx_info *pi2s_tx)
 112 {
 113         int ret;
 114         const char *codectype;
 115 #ifdef CONFIG_OF_CONTROL
 116         int node;
 117
 118         /* Get the node from FDT for sound */
 119         node = fdt_path_offset(blob, "i2s");
 120         if (node <= 0) {
 121                 debug("EXYNOS_SOUND: No node for sound in device tree\n");
 122                 debug("node = %d\n", node);
 123                 return -1;
 124         }
 125
 126         /*
 127          * Get the pre-defined sound codec specific values from FDT.
 128          * All of these are expected to be correct otherwise sound
 129          * can not be played
 130          */
 131         codectype = fdt_getprop(blob, node, "samsung,codec-type", NULL);
 132         debug("device = %s\n", codectype);
 133 #else
 134         codectype =  AUDIO_CODEC;
 135 #endif
 136         if (!strcmp(codectype, "wm8994")) {
 137                 /* Check the codec type and initialise the same */
 138                 ret = wm8994_init(blob, pi2s_tx->id + 1,
 139                                   pi2s_tx->samplingrate,
 140                                   (pi2s_tx->samplingrate * (pi2s_tx->rfs)),
 141                                   pi2s_tx->bitspersample, pi2s_tx->channels);
 142         } else if (!strcmp(codectype, "max98095")) {
 143                 ret = max98095_init(blob, pi2s_tx->id + 1,
 144                                     pi2s_tx->samplingrate,
 145                                     (pi2s_tx->samplingrate * (pi2s_tx->rfs)),
 146                                     pi2s_tx->bitspersample);
 147         } else {
 148                 debug("%s: Unknown codec type %s\n", __func__, codectype);
 149                 return -1;
 150         }
 151
 152         if (ret) {
 153                 debug("%s: Codec init failed\n", __func__);
 154                 return -1;
 155         }
 156
 157         return 0;
 158 }
 159
 160 int sound_init(const void *blob)
 161 {
 162         int ret;
 163         struct i2stx_info *pi2s_tx = &g_i2stx_pri;
 164
 165         /* Get the I2S Values */
 166         if (get_sound_i2s_values(pi2s_tx, blob) < 0) {
 167                 debug(" FDT I2S values failed\n");
 168                 return -1;
 169         }
 170
 171         if (codec_init(blob, pi2s_tx) < 0) {
 172                 debug(" Codec init failed\n");
 173                 return -1;
 174         }
 175
 176         ret = i2s_tx_init(pi2s_tx);
 177         if (ret) {
 178                 debug("%s: Failed to init i2c transmit: ret=%d\n", __func__,
 179                       ret);
 180                 return ret;
 181         }
 182
 183
 184         return ret;
 185 }
 186
 187 /*
 188  * Generates square wave sound data for 1 second
 189  *
 190  * @param data          data buffer pointer
 191  * @param size          size of the buffer
 192  * @param freq          frequency of the wave
 193  */
 194 static void sound_prepare_buffer(unsigned short *data, int size, uint32_t freq)
 195 {
 196         const int sample = 48000;
 197         const unsigned short amplitude = 16000; /* between 1 and 32767 */
 198         const int period = freq ? sample / freq : 0;
 199         const int half = period / 2;
 200
 201         assert(freq);
 202
 203         /* Make sure we don't overflow our buffer */
 204         if (size % 2)
 205                 size--;
 206
 207         while (size) {
 208                 int i;
 209                 for (i = 0; size && i < half; i++) {
 210                         size -= 2;
 211                         *data++ = amplitude;
 212                         *data++ = amplitude;
 213                 }
 214                 for (i = 0; size && i < period - half; i++) {
 215                         size -= 2;
 216                         *data++ = -amplitude;
 217                         *data++ = -amplitude;
 218                 }
 219         }
 220 }
 221
 222 int sound_play(uint32_t msec, uint32_t frequency)
 223 {
 224         unsigned int *data;
 225         unsigned long data_size;
 226         unsigned int ret = 0;
 227
 228         /*Buffer length computation */
 229         data_size = g_i2stx_pri.samplingrate * g_i2stx_pri.channels;
 230         data_size *= (g_i2stx_pri.bitspersample / SOUND_BITS_IN_BYTE);
 231         data = malloc(data_size);
 232
 233         if (data == NULL) {
 234                 debug("%s: malloc failed\n", __func__);
 235                 return -1;
 236         }
 237
 238         sound_prepare_buffer((unsigned short *)data,
 239                              data_size / sizeof(unsigned short), frequency);
 240
 241         while (msec >= 1000) {
 242                 ret = i2s_transfer_tx_data(&g_i2stx_pri, data,
 243                                            (data_size / sizeof(int)));
 244                 msec -= 1000;
 245         }
 246         if (msec) {
 247                 unsigned long size =
 248                         (data_size * msec) / (sizeof(int) * 1000);
 249
 250                 ret = i2s_transfer_tx_data(&g_i2stx_pri, data, size);
 251         }
 252
 253         free(data);
 254
 255         return ret;
 256 }