| 123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207 | // SPDX-License-Identifier: GPL-2.0+/* * Copyright (C) 2012 Samsung Electronics * R. Chandrasekar <rcsekar@samsung.com> */#include <malloc.h>#include <common.h>#include <asm/io.h>#include <linux/libfdt.h>#include <fdtdec.h>#include <i2c.h>#include <i2s.h>#include <sound.h>#include <asm/arch/sound.h>#include "wm8994.h"#include "max98095.h"/* defines */#define SOUND_400_HZ 400#define SOUND_BITS_IN_BYTE 8static struct i2stx_info g_i2stx_pri;/* * get_sound_i2s_values gets values for i2s parameters * * @param i2stx_info	i2s transmitter transfer param structure * @param blob		FDT blob if enabled else NULL */static int get_sound_i2s_values(struct i2stx_info *i2s, const void *blob){	int node;	int error = 0;	int base;	node = fdt_path_offset(blob, "i2s");	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);	i2s->id = fdtdec_get_int(blob, node, "samsung,i2s-id", -1);	error |= i2s->id;	debug("id = %d\n", i2s->id);	if (error == -1) {		debug("fail to get sound i2s node properties\n");		return -1;	}	return 0;}/* * Init codec * * @param blob          FDT blob * @param pi2s_tx	i2s parameters required by codec * @return              int value, 0 for success */static int codec_init(const void *blob, struct i2stx_info *pi2s_tx){	int ret;	const char *codectype;	int node;	/* Get the node from FDT for sound */	node = fdt_path_offset(blob, "i2s");	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")) {		/* Check the codec type and initialise the same */		ret = wm8994_init(blob, pi2s_tx->id + 1,				  pi2s_tx->samplingrate,				  (pi2s_tx->samplingrate * (pi2s_tx->rfs)),				  pi2s_tx->bitspersample, pi2s_tx->channels);	} else if (!strcmp(codectype, "max98095")) {		ret = max98095_init(blob, pi2s_tx->id + 1,				    pi2s_tx->samplingrate,				    (pi2s_tx->samplingrate * (pi2s_tx->rfs)),				    pi2s_tx->bitspersample);	} else {		debug("%s: Unknown codec type %s\n", __func__, codectype);		return -1;	}	if (ret) {		debug("%s: Codec init failed\n", __func__);		return -1;	}	return 0;}int sound_init(const void *blob){	int ret;	struct i2stx_info *pi2s_tx = &g_i2stx_pri;	/* Get the I2S Values */	if (get_sound_i2s_values(pi2s_tx, blob) < 0) {		debug(" FDT I2S values failed\n");		return -1;	}	if (codec_init(blob, pi2s_tx) < 0) {		debug(" Codec init 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;	}	return ret;}int sound_play(uint32_t msec, uint32_t frequency){	unsigned int *data;	unsigned long data_size;	unsigned int ret = 0;	/*Buffer length computation */	data_size = g_i2stx_pri.samplingrate * g_i2stx_pri.channels;	data_size *= (g_i2stx_pri.bitspersample / SOUND_BITS_IN_BYTE);	data = malloc(data_size);	if (data == NULL) {		debug("%s: malloc failed\n", __func__);		return -1;	}	sound_create_square_wave((unsigned short *)data,				 data_size / sizeof(unsigned short),				 frequency);	while (msec >= 1000) {		ret = i2s_transfer_tx_data(&g_i2stx_pri, data,					   (data_size / sizeof(int)));		msec -= 1000;	}	if (msec) {		unsigned long size =			(data_size * msec) / (sizeof(int) * 1000);		ret = i2s_transfer_tx_data(&g_i2stx_pri, data, size);	}	free(data);	return ret;}
 |