| /* |
| * siu_dai.c - ALSA SoC driver for Renesas SH7343, SH7722 SIU peripheral. |
| * |
| * Copyright (C) 2009-2010 Guennadi Liakhovetski <g.liakhovetski@gmx.de> |
| * Copyright (C) 2006 Carlos Munoz <carlos@kenati.com> |
| * |
| * This program is free software; you can redistribute it and/or modify |
| * it under the terms of the GNU General Public License as published by |
| * the Free Software Foundation; either version 2 of the License, or |
| * (at your option) any later version. |
| * |
| * This program is distributed in the hope that it will be useful, |
| * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| * GNU General Public License for more details. |
| * |
| * You should have received a copy of the GNU General Public License |
| * along with this program; if not, write to the Free Software |
| * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. |
| */ |
| |
| #include <linux/delay.h> |
| #include <linux/firmware.h> |
| #include <linux/pm_runtime.h> |
| #include <linux/slab.h> |
| #include <linux/module.h> |
| |
| #include <asm/clock.h> |
| #include <asm/siu.h> |
| |
| #include <sound/control.h> |
| #include <sound/soc.h> |
| |
| #include "siu.h" |
| |
| /* Board specifics */ |
| #if defined(CONFIG_CPU_SUBTYPE_SH7722) |
| # define SIU_MAX_VOLUME 0x1000 |
| #else |
| # define SIU_MAX_VOLUME 0x7fff |
| #endif |
| |
| #define PRAM_SIZE 0x2000 |
| #define XRAM_SIZE 0x800 |
| #define YRAM_SIZE 0x800 |
| |
| #define XRAM_OFFSET 0x4000 |
| #define YRAM_OFFSET 0x6000 |
| #define REG_OFFSET 0xc000 |
| |
| #define PLAYBACK_ENABLED 1 |
| #define CAPTURE_ENABLED 2 |
| |
| #define VOLUME_CAPTURE 0 |
| #define VOLUME_PLAYBACK 1 |
| #define DFLT_VOLUME_LEVEL 0x08000800 |
| |
| /* |
| * SPDIF is only available on port A and on some SIU implementations it is only |
| * available for input. Due to the lack of hardware to test it, SPDIF is left |
| * disabled in this driver version |
| */ |
| struct format_flag { |
| u32 i2s; |
| u32 pcm; |
| u32 spdif; |
| u32 mask; |
| }; |
| |
| struct port_flag { |
| struct format_flag playback; |
| struct format_flag capture; |
| }; |
| |
| struct siu_info *siu_i2s_data; |
| |
| static struct port_flag siu_flags[SIU_PORT_NUM] = { |
| [SIU_PORT_A] = { |
| .playback = { |
| .i2s = 0x50000000, |
| .pcm = 0x40000000, |
| .spdif = 0x80000000, /* not on all SIU versions */ |
| .mask = 0xd0000000, |
| }, |
| .capture = { |
| .i2s = 0x05000000, |
| .pcm = 0x04000000, |
| .spdif = 0x08000000, |
| .mask = 0x0d000000, |
| }, |
| }, |
| [SIU_PORT_B] = { |
| .playback = { |
| .i2s = 0x00500000, |
| .pcm = 0x00400000, |
| .spdif = 0, /* impossible - turn off */ |
| .mask = 0x00500000, |
| }, |
| .capture = { |
| .i2s = 0x00050000, |
| .pcm = 0x00040000, |
| .spdif = 0, /* impossible - turn off */ |
| .mask = 0x00050000, |
| }, |
| }, |
| }; |
| |
| static void siu_dai_start(struct siu_port *port_info) |
| { |
| struct siu_info *info = siu_i2s_data; |
| u32 __iomem *base = info->reg; |
| |
| dev_dbg(port_info->pcm->card->dev, "%s\n", __func__); |
| |
| /* Issue software reset to siu */ |
| siu_write32(base + SIU_SRCTL, 0); |
| |
| /* Wait for the reset to take effect */ |
| udelay(1); |
| |
| port_info->stfifo = 0; |
| port_info->trdat = 0; |
| |
| /* portA, portB, SIU operate */ |
| siu_write32(base + SIU_SRCTL, 0x301); |
| |
| /* portA=256fs, portB=256fs */ |
| siu_write32(base + SIU_CKCTL, 0x40400000); |
| |
| /* portA's BRG does not divide SIUCKA */ |
| siu_write32(base + SIU_BRGASEL, 0); |
| siu_write32(base + SIU_BRRA, 0); |
| |
| /* portB's BRG divides SIUCKB by half */ |
| siu_write32(base + SIU_BRGBSEL, 1); |
| siu_write32(base + SIU_BRRB, 0); |
| |
| siu_write32(base + SIU_IFCTL, 0x44440000); |
| |
| /* portA: 32 bit/fs, master; portB: 32 bit/fs, master */ |
| siu_write32(base + SIU_SFORM, 0x0c0c0000); |
| |
| /* |
| * Volume levels: looks like the DSP firmware implements volume controls |
| * differently from what's described in the datasheet |
| */ |
| siu_write32(base + SIU_SBDVCA, port_info->playback.volume); |
| siu_write32(base + SIU_SBDVCB, port_info->capture.volume); |
| } |
| |
| static void siu_dai_stop(struct siu_port *port_info) |
| { |
| struct siu_info *info = siu_i2s_data; |
| u32 __iomem *base = info->reg; |
| |
| /* SIU software reset */ |
| siu_write32(base + SIU_SRCTL, 0); |
| } |
| |
| static void siu_dai_spbAselect(struct siu_port *port_info) |
| { |
| struct siu_info *info = siu_i2s_data; |
| struct siu_firmware *fw = &info->fw; |
| u32 *ydef = fw->yram0; |
| u32 idx; |
| |
| /* path A use */ |
| if (!info->port_id) |
| idx = 1; /* portA */ |
| else |
| idx = 2; /* portB */ |
| |
| ydef[0] = (fw->spbpar[idx].ab1a << 16) | |
| (fw->spbpar[idx].ab0a << 8) | |
| (fw->spbpar[idx].dir << 7) | 3; |
| ydef[1] = fw->yram0[1]; /* 0x03000300 */ |
| ydef[2] = (16 / 2) << 24; |
| ydef[3] = fw->yram0[3]; /* 0 */ |
| ydef[4] = fw->yram0[4]; /* 0 */ |
| ydef[7] = fw->spbpar[idx].event; |
| port_info->stfifo |= fw->spbpar[idx].stfifo; |
| port_info->trdat |= fw->spbpar[idx].trdat; |
| } |
| |
| static void siu_dai_spbBselect(struct siu_port *port_info) |
| { |
| struct siu_info *info = siu_i2s_data; |
| struct siu_firmware *fw = &info->fw; |
| u32 *ydef = fw->yram0; |
| u32 idx; |
| |
| /* path B use */ |
| if (!info->port_id) |
| idx = 7; /* portA */ |
| else |
| idx = 8; /* portB */ |
| |
| ydef[5] = (fw->spbpar[idx].ab1a << 16) | |
| (fw->spbpar[idx].ab0a << 8) | 1; |
| ydef[6] = fw->spbpar[idx].event; |
| port_info->stfifo |= fw->spbpar[idx].stfifo; |
| port_info->trdat |= fw->spbpar[idx].trdat; |
| } |
| |
| static void siu_dai_open(struct siu_stream *siu_stream) |
| { |
| struct siu_info *info = siu_i2s_data; |
| u32 __iomem *base = info->reg; |
| u32 srctl, ifctl; |
| |
| srctl = siu_read32(base + SIU_SRCTL); |
| ifctl = siu_read32(base + SIU_IFCTL); |
| |
| switch (info->port_id) { |
| case SIU_PORT_A: |
| /* portA operates */ |
| srctl |= 0x200; |
| ifctl &= ~0xc2; |
| break; |
| case SIU_PORT_B: |
| /* portB operates */ |
| srctl |= 0x100; |
| ifctl &= ~0x31; |
| break; |
| } |
| |
| siu_write32(base + SIU_SRCTL, srctl); |
| /* Unmute and configure portA */ |
| siu_write32(base + SIU_IFCTL, ifctl); |
| } |
| |
| /* |
| * At the moment only fixed Left-upper, Left-lower, Right-upper, Right-lower |
| * packing is supported |
| */ |
| static void siu_dai_pcmdatapack(struct siu_stream *siu_stream) |
| { |
| struct siu_info *info = siu_i2s_data; |
| u32 __iomem *base = info->reg; |
| u32 dpak; |
| |
| dpak = siu_read32(base + SIU_DPAK); |
| |
| switch (info->port_id) { |
| case SIU_PORT_A: |
| dpak &= ~0xc0000000; |
| break; |
| case SIU_PORT_B: |
| dpak &= ~0x00c00000; |
| break; |
| } |
| |
| siu_write32(base + SIU_DPAK, dpak); |
| } |
| |
| static int siu_dai_spbstart(struct siu_port *port_info) |
| { |
| struct siu_info *info = siu_i2s_data; |
| u32 __iomem *base = info->reg; |
| struct siu_firmware *fw = &info->fw; |
| u32 *ydef = fw->yram0; |
| int cnt; |
| u32 __iomem *add; |
| u32 *ptr; |
| |
| /* Load SPB Program in PRAM */ |
| ptr = fw->pram0; |
| add = info->pram; |
| for (cnt = 0; cnt < PRAM0_SIZE; cnt++, add++, ptr++) |
| siu_write32(add, *ptr); |
| |
| ptr = fw->pram1; |
| add = info->pram + (0x0100 / sizeof(u32)); |
| for (cnt = 0; cnt < PRAM1_SIZE; cnt++, add++, ptr++) |
| siu_write32(add, *ptr); |
| |
| /* XRAM initialization */ |
| add = info->xram; |
| for (cnt = 0; cnt < XRAM0_SIZE + XRAM1_SIZE + XRAM2_SIZE; cnt++, add++) |
| siu_write32(add, 0); |
| |
| /* YRAM variable area initialization */ |
| add = info->yram; |
| for (cnt = 0; cnt < YRAM_DEF_SIZE; cnt++, add++) |
| siu_write32(add, ydef[cnt]); |
| |
| /* YRAM FIR coefficient area initialization */ |
| add = info->yram + (0x0200 / sizeof(u32)); |
| for (cnt = 0; cnt < YRAM_FIR_SIZE; cnt++, add++) |
| siu_write32(add, fw->yram_fir_coeff[cnt]); |
| |
| /* YRAM IIR coefficient area initialization */ |
| add = info->yram + (0x0600 / sizeof(u32)); |
| for (cnt = 0; cnt < YRAM_IIR_SIZE; cnt++, add++) |
| siu_write32(add, 0); |
| |
| siu_write32(base + SIU_TRDAT, port_info->trdat); |
| port_info->trdat = 0x0; |
| |
| |
| /* SPB start condition: software */ |
| siu_write32(base + SIU_SBACTIV, 0); |
| /* Start SPB */ |
| siu_write32(base + SIU_SBCTL, 0xc0000000); |
| /* Wait for program to halt */ |
| cnt = 0x10000; |
| while (--cnt && siu_read32(base + SIU_SBCTL) != 0x80000000) |
| cpu_relax(); |
| |
| if (!cnt) |
| return -EBUSY; |
| |
| /* SPB program start address setting */ |
| siu_write32(base + SIU_SBPSET, 0x00400000); |
| /* SPB hardware start(FIFOCTL source) */ |
| siu_write32(base + SIU_SBACTIV, 0xc0000000); |
| |
| return 0; |
| } |
| |
| static void siu_dai_spbstop(struct siu_port *port_info) |
| { |
| struct siu_info *info = siu_i2s_data; |
| u32 __iomem *base = info->reg; |
| |
| siu_write32(base + SIU_SBACTIV, 0); |
| /* SPB stop */ |
| siu_write32(base + SIU_SBCTL, 0); |
| |
| port_info->stfifo = 0; |
| } |
| |
| /* API functions */ |
| |
| /* Playback and capture hardware properties are identical */ |
| static struct snd_pcm_hardware siu_dai_pcm_hw = { |
| .info = SNDRV_PCM_INFO_INTERLEAVED, |
| .formats = SNDRV_PCM_FMTBIT_S16, |
| .rates = SNDRV_PCM_RATE_8000_48000, |
| .rate_min = 8000, |
| .rate_max = 48000, |
| .channels_min = 2, |
| .channels_max = 2, |
| .buffer_bytes_max = SIU_BUFFER_BYTES_MAX, |
| .period_bytes_min = SIU_PERIOD_BYTES_MIN, |
| .period_bytes_max = SIU_PERIOD_BYTES_MAX, |
| .periods_min = SIU_PERIODS_MIN, |
| .periods_max = SIU_PERIODS_MAX, |
| }; |
| |
| static int siu_dai_info_volume(struct snd_kcontrol *kctrl, |
| struct snd_ctl_elem_info *uinfo) |
| { |
| struct siu_port *port_info = snd_kcontrol_chip(kctrl); |
| |
| dev_dbg(port_info->pcm->card->dev, "%s\n", __func__); |
| |
| uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER; |
| uinfo->count = 2; |
| uinfo->value.integer.min = 0; |
| uinfo->value.integer.max = SIU_MAX_VOLUME; |
| |
| return 0; |
| } |
| |
| static int siu_dai_get_volume(struct snd_kcontrol *kctrl, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| struct siu_port *port_info = snd_kcontrol_chip(kctrl); |
| struct device *dev = port_info->pcm->card->dev; |
| u32 vol; |
| |
| dev_dbg(dev, "%s\n", __func__); |
| |
| switch (kctrl->private_value) { |
| case VOLUME_PLAYBACK: |
| /* Playback is always on port 0 */ |
| vol = port_info->playback.volume; |
| ucontrol->value.integer.value[0] = vol & 0xffff; |
| ucontrol->value.integer.value[1] = vol >> 16 & 0xffff; |
| break; |
| case VOLUME_CAPTURE: |
| /* Capture is always on port 1 */ |
| vol = port_info->capture.volume; |
| ucontrol->value.integer.value[0] = vol & 0xffff; |
| ucontrol->value.integer.value[1] = vol >> 16 & 0xffff; |
| break; |
| default: |
| dev_err(dev, "%s() invalid private_value=%ld\n", |
| __func__, kctrl->private_value); |
| return -EINVAL; |
| } |
| |
| return 0; |
| } |
| |
| static int siu_dai_put_volume(struct snd_kcontrol *kctrl, |
| struct snd_ctl_elem_value *ucontrol) |
| { |
| struct siu_port *port_info = snd_kcontrol_chip(kctrl); |
| struct device *dev = port_info->pcm->card->dev; |
| struct siu_info *info = siu_i2s_data; |
| u32 __iomem *base = info->reg; |
| u32 new_vol; |
| u32 cur_vol; |
| |
| dev_dbg(dev, "%s\n", __func__); |
| |
| if (ucontrol->value.integer.value[0] < 0 || |
| ucontrol->value.integer.value[0] > SIU_MAX_VOLUME || |
| ucontrol->value.integer.value[1] < 0 || |
| ucontrol->value.integer.value[1] > SIU_MAX_VOLUME) |
| return -EINVAL; |
| |
| new_vol = ucontrol->value.integer.value[0] | |
| ucontrol->value.integer.value[1] << 16; |
| |
| /* See comment above - DSP firmware implementation */ |
| switch (kctrl->private_value) { |
| case VOLUME_PLAYBACK: |
| /* Playback is always on port 0 */ |
| cur_vol = port_info->playback.volume; |
| siu_write32(base + SIU_SBDVCA, new_vol); |
| port_info->playback.volume = new_vol; |
| break; |
| case VOLUME_CAPTURE: |
| /* Capture is always on port 1 */ |
| cur_vol = port_info->capture.volume; |
| siu_write32(base + SIU_SBDVCB, new_vol); |
| port_info->capture.volume = new_vol; |
| break; |
| default: |
| dev_err(dev, "%s() invalid private_value=%ld\n", |
| __func__, kctrl->private_value); |
| return -EINVAL; |
| } |
| |
| if (cur_vol != new_vol) |
| return 1; |
| |
| return 0; |
| } |
| |
| static struct snd_kcontrol_new playback_controls = { |
| .iface = SNDRV_CTL_ELEM_IFACE_MIXER, |
| .name = "PCM Playback Volume", |
| .index = 0, |
| .info = siu_dai_info_volume, |
| .get = siu_dai_get_volume, |
| .put = siu_dai_put_volume, |
| .private_value = VOLUME_PLAYBACK, |
| }; |
| |
| static struct snd_kcontrol_new capture_controls = { |
| .iface = SNDRV_CTL_ELEM_IFACE_MIXER, |
| .name = "PCM Capture Volume", |
| .index = 0, |
| .info = siu_dai_info_volume, |
| .get = siu_dai_get_volume, |
| .put = siu_dai_put_volume, |
| .private_value = VOLUME_CAPTURE, |
| }; |
| |
| int siu_init_port(int port, struct siu_port **port_info, struct snd_card *card) |
| { |
| struct device *dev = card->dev; |
| struct snd_kcontrol *kctrl; |
| int ret; |
| |
| *port_info = kzalloc(sizeof(**port_info), GFP_KERNEL); |
| if (!*port_info) |
| return -ENOMEM; |
| |
| dev_dbg(dev, "%s: port #%d@%p\n", __func__, port, *port_info); |
| |
| (*port_info)->playback.volume = DFLT_VOLUME_LEVEL; |
| (*port_info)->capture.volume = DFLT_VOLUME_LEVEL; |
| |
| /* |
| * Add mixer support. The SPB is used to change the volume. Both |
| * ports use the same SPB. Therefore, we only register one |
| * control instance since it will be used by both channels. |
| * In error case we continue without controls. |
| */ |
| kctrl = snd_ctl_new1(&playback_controls, *port_info); |
| ret = snd_ctl_add(card, kctrl); |
| if (ret < 0) |
| dev_err(dev, |
| "failed to add playback controls %p port=%d err=%d\n", |
| kctrl, port, ret); |
| |
| kctrl = snd_ctl_new1(&capture_controls, *port_info); |
| ret = snd_ctl_add(card, kctrl); |
| if (ret < 0) |
| dev_err(dev, |
| "failed to add capture controls %p port=%d err=%d\n", |
| kctrl, port, ret); |
| |
| return 0; |
| } |
| |
| void siu_free_port(struct siu_port *port_info) |
| { |
| kfree(port_info); |
| } |
| |
| static int siu_dai_startup(struct snd_pcm_substream *substream, |
| struct snd_soc_dai *dai) |
| { |
| struct siu_info *info = snd_soc_dai_get_drvdata(dai); |
| struct snd_pcm_runtime *rt = substream->runtime; |
| struct siu_port *port_info = siu_port_info(substream); |
| int ret; |
| |
| dev_dbg(substream->pcm->card->dev, "%s: port=%d@%p\n", __func__, |
| info->port_id, port_info); |
| |
| snd_soc_set_runtime_hwparams(substream, &siu_dai_pcm_hw); |
| |
| ret = snd_pcm_hw_constraint_integer(rt, SNDRV_PCM_HW_PARAM_PERIODS); |
| if (unlikely(ret < 0)) |
| return ret; |
| |
| siu_dai_start(port_info); |
| |
| return 0; |
| } |
| |
| static void siu_dai_shutdown(struct snd_pcm_substream *substream, |
| struct snd_soc_dai *dai) |
| { |
| struct siu_info *info = snd_soc_dai_get_drvdata(dai); |
| struct siu_port *port_info = siu_port_info(substream); |
| |
| dev_dbg(substream->pcm->card->dev, "%s: port=%d@%p\n", __func__, |
| info->port_id, port_info); |
| |
| if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) |
| port_info->play_cap &= ~PLAYBACK_ENABLED; |
| else |
| port_info->play_cap &= ~CAPTURE_ENABLED; |
| |
| /* Stop the siu if the other stream is not using it */ |
| if (!port_info->play_cap) { |
| /* during stmread or stmwrite ? */ |
| BUG_ON(port_info->playback.rw_flg || port_info->capture.rw_flg); |
| siu_dai_spbstop(port_info); |
| siu_dai_stop(port_info); |
| } |
| } |
| |
| /* PCM part of siu_dai_playback_prepare() / siu_dai_capture_prepare() */ |
| static int siu_dai_prepare(struct snd_pcm_substream *substream, |
| struct snd_soc_dai *dai) |
| { |
| struct siu_info *info = snd_soc_dai_get_drvdata(dai); |
| struct snd_pcm_runtime *rt = substream->runtime; |
| struct siu_port *port_info = siu_port_info(substream); |
| struct siu_stream *siu_stream; |
| int self, ret; |
| |
| dev_dbg(substream->pcm->card->dev, |
| "%s: port %d, active streams %lx, %d channels\n", |
| __func__, info->port_id, port_info->play_cap, rt->channels); |
| |
| if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) { |
| self = PLAYBACK_ENABLED; |
| siu_stream = &port_info->playback; |
| } else { |
| self = CAPTURE_ENABLED; |
| siu_stream = &port_info->capture; |
| } |
| |
| /* Set up the siu if not already done */ |
| if (!port_info->play_cap) { |
| siu_stream->rw_flg = 0; /* stream-data transfer flag */ |
| |
| siu_dai_spbAselect(port_info); |
| siu_dai_spbBselect(port_info); |
| |
| siu_dai_open(siu_stream); |
| |
| siu_dai_pcmdatapack(siu_stream); |
| |
| ret = siu_dai_spbstart(port_info); |
| if (ret < 0) |
| goto fail; |
| } else { |
| ret = 0; |
| } |
| |
| port_info->play_cap |= self; |
| |
| fail: |
| return ret; |
| } |
| |
| /* |
| * SIU can set bus format to I2S / PCM / SPDIF independently for playback and |
| * capture, however, the current API sets the bus format globally for a DAI. |
| */ |
| static int siu_dai_set_fmt(struct snd_soc_dai *dai, |
| unsigned int fmt) |
| { |
| struct siu_info *info = snd_soc_dai_get_drvdata(dai); |
| u32 __iomem *base = info->reg; |
| u32 ifctl; |
| |
| dev_dbg(dai->dev, "%s: fmt 0x%x on port %d\n", |
| __func__, fmt, info->port_id); |
| |
| if (info->port_id < 0) |
| return -ENODEV; |
| |
| /* Here select between I2S / PCM / SPDIF */ |
| switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) { |
| case SND_SOC_DAIFMT_I2S: |
| ifctl = siu_flags[info->port_id].playback.i2s | |
| siu_flags[info->port_id].capture.i2s; |
| break; |
| case SND_SOC_DAIFMT_LEFT_J: |
| ifctl = siu_flags[info->port_id].playback.pcm | |
| siu_flags[info->port_id].capture.pcm; |
| break; |
| /* SPDIF disabled - see comment at the top */ |
| default: |
| return -EINVAL; |
| } |
| |
| ifctl |= ~(siu_flags[info->port_id].playback.mask | |
| siu_flags[info->port_id].capture.mask) & |
| siu_read32(base + SIU_IFCTL); |
| siu_write32(base + SIU_IFCTL, ifctl); |
| |
| return 0; |
| } |
| |
| static int siu_dai_set_sysclk(struct snd_soc_dai *dai, int clk_id, |
| unsigned int freq, int dir) |
| { |
| struct clk *siu_clk, *parent_clk; |
| char *siu_name, *parent_name; |
| int ret; |
| |
| if (dir != SND_SOC_CLOCK_IN) |
| return -EINVAL; |
| |
| dev_dbg(dai->dev, "%s: using clock %d\n", __func__, clk_id); |
| |
| switch (clk_id) { |
| case SIU_CLKA_PLL: |
| siu_name = "siua_clk"; |
| parent_name = "pll_clk"; |
| break; |
| case SIU_CLKA_EXT: |
| siu_name = "siua_clk"; |
| parent_name = "siumcka_clk"; |
| break; |
| case SIU_CLKB_PLL: |
| siu_name = "siub_clk"; |
| parent_name = "pll_clk"; |
| break; |
| case SIU_CLKB_EXT: |
| siu_name = "siub_clk"; |
| parent_name = "siumckb_clk"; |
| break; |
| default: |
| return -EINVAL; |
| } |
| |
| siu_clk = clk_get(dai->dev, siu_name); |
| if (IS_ERR(siu_clk)) { |
| dev_err(dai->dev, "%s: cannot get a SIU clock: %ld\n", __func__, |
| PTR_ERR(siu_clk)); |
| return PTR_ERR(siu_clk); |
| } |
| |
| parent_clk = clk_get(dai->dev, parent_name); |
| if (IS_ERR(parent_clk)) { |
| ret = PTR_ERR(parent_clk); |
| dev_err(dai->dev, "cannot get a SIU clock parent: %d\n", ret); |
| goto epclkget; |
| } |
| |
| ret = clk_set_parent(siu_clk, parent_clk); |
| if (ret < 0) { |
| dev_err(dai->dev, "cannot reparent the SIU clock: %d\n", ret); |
| goto eclksetp; |
| } |
| |
| ret = clk_set_rate(siu_clk, freq); |
| if (ret < 0) |
| dev_err(dai->dev, "cannot set SIU clock rate: %d\n", ret); |
| |
| /* TODO: when clkdev gets reference counting we'll move these to siu_dai_shutdown() */ |
| eclksetp: |
| clk_put(parent_clk); |
| epclkget: |
| clk_put(siu_clk); |
| |
| return ret; |
| } |
| |
| static const struct snd_soc_dai_ops siu_dai_ops = { |
| .startup = siu_dai_startup, |
| .shutdown = siu_dai_shutdown, |
| .prepare = siu_dai_prepare, |
| .set_sysclk = siu_dai_set_sysclk, |
| .set_fmt = siu_dai_set_fmt, |
| }; |
| |
| static struct snd_soc_dai_driver siu_i2s_dai = { |
| .name = "siu-i2s-dai", |
| .playback = { |
| .channels_min = 2, |
| .channels_max = 2, |
| .formats = SNDRV_PCM_FMTBIT_S16, |
| .rates = SNDRV_PCM_RATE_8000_48000, |
| }, |
| .capture = { |
| .channels_min = 2, |
| .channels_max = 2, |
| .formats = SNDRV_PCM_FMTBIT_S16, |
| .rates = SNDRV_PCM_RATE_8000_48000, |
| }, |
| .ops = &siu_dai_ops, |
| }; |
| |
| static int siu_probe(struct platform_device *pdev) |
| { |
| const struct firmware *fw_entry; |
| struct resource *res, *region; |
| struct siu_info *info; |
| int ret; |
| |
| info = kmalloc(sizeof(*info), GFP_KERNEL); |
| if (!info) |
| return -ENOMEM; |
| siu_i2s_data = info; |
| info->dev = &pdev->dev; |
| |
| ret = request_firmware(&fw_entry, "siu_spb.bin", &pdev->dev); |
| if (ret) |
| goto ereqfw; |
| |
| /* |
| * Loaded firmware is "const" - read only, but we have to modify it in |
| * snd_siu_sh7343_spbAselect() and snd_siu_sh7343_spbBselect() |
| */ |
| memcpy(&info->fw, fw_entry->data, fw_entry->size); |
| |
| release_firmware(fw_entry); |
| |
| res = platform_get_resource(pdev, IORESOURCE_MEM, 0); |
| if (!res) { |
| ret = -ENODEV; |
| goto egetres; |
| } |
| |
| region = request_mem_region(res->start, resource_size(res), |
| pdev->name); |
| if (!region) { |
| dev_err(&pdev->dev, "SIU region already claimed\n"); |
| ret = -EBUSY; |
| goto ereqmemreg; |
| } |
| |
| ret = -ENOMEM; |
| info->pram = ioremap(res->start, PRAM_SIZE); |
| if (!info->pram) |
| goto emappram; |
| info->xram = ioremap(res->start + XRAM_OFFSET, XRAM_SIZE); |
| if (!info->xram) |
| goto emapxram; |
| info->yram = ioremap(res->start + YRAM_OFFSET, YRAM_SIZE); |
| if (!info->yram) |
| goto emapyram; |
| info->reg = ioremap(res->start + REG_OFFSET, resource_size(res) - |
| REG_OFFSET); |
| if (!info->reg) |
| goto emapreg; |
| |
| dev_set_drvdata(&pdev->dev, info); |
| |
| /* register using ARRAY version so we can keep dai name */ |
| ret = snd_soc_register_dais(&pdev->dev, &siu_i2s_dai, 1); |
| if (ret < 0) |
| goto edaiinit; |
| |
| ret = snd_soc_register_platform(&pdev->dev, &siu_platform); |
| if (ret < 0) |
| goto esocregp; |
| |
| pm_runtime_enable(&pdev->dev); |
| |
| return ret; |
| |
| esocregp: |
| snd_soc_unregister_dai(&pdev->dev); |
| edaiinit: |
| iounmap(info->reg); |
| emapreg: |
| iounmap(info->yram); |
| emapyram: |
| iounmap(info->xram); |
| emapxram: |
| iounmap(info->pram); |
| emappram: |
| release_mem_region(res->start, resource_size(res)); |
| ereqmemreg: |
| egetres: |
| ereqfw: |
| kfree(info); |
| |
| return ret; |
| } |
| |
| static int siu_remove(struct platform_device *pdev) |
| { |
| struct siu_info *info = dev_get_drvdata(&pdev->dev); |
| struct resource *res; |
| |
| pm_runtime_disable(&pdev->dev); |
| |
| snd_soc_unregister_platform(&pdev->dev); |
| snd_soc_unregister_dai(&pdev->dev); |
| |
| iounmap(info->reg); |
| iounmap(info->yram); |
| iounmap(info->xram); |
| iounmap(info->pram); |
| res = platform_get_resource(pdev, IORESOURCE_MEM, 0); |
| if (res) |
| release_mem_region(res->start, resource_size(res)); |
| kfree(info); |
| |
| return 0; |
| } |
| |
| static struct platform_driver siu_driver = { |
| .driver = { |
| .owner = THIS_MODULE, |
| .name = "siu-pcm-audio", |
| }, |
| .probe = siu_probe, |
| .remove = siu_remove, |
| }; |
| |
| module_platform_driver(siu_driver); |
| |
| MODULE_AUTHOR("Carlos Munoz <carlos@kenati.com>"); |
| MODULE_DESCRIPTION("ALSA SoC SH7722 SIU driver"); |
| MODULE_LICENSE("GPL"); |