Author | Tokens | Token Proportion | Commits | Commit Proportion |
---|---|---|---|---|
Kuninori Morimoto | 4421 | 92.47% | 152 | 88.37% |
Yongbo Zhang | 127 | 2.66% | 1 | 0.58% |
Dragos Tarcatu | 90 | 1.88% | 2 | 1.16% |
Jiada Wang | 55 | 1.15% | 5 | 2.91% |
Julia Lawall | 29 | 0.61% | 2 | 1.16% |
Matthias Blankertz | 23 | 0.48% | 3 | 1.74% |
Andrzej Hajda | 10 | 0.21% | 1 | 0.58% |
Takashi Iwai | 7 | 0.15% | 1 | 0.58% |
Argus Lin | 6 | 0.13% | 1 | 0.58% |
Colin Ian King | 6 | 0.13% | 1 | 0.58% |
Kees Cook | 3 | 0.06% | 1 | 0.58% |
Jiasheng Jiang | 2 | 0.04% | 1 | 0.58% |
Rob Herring | 2 | 0.04% | 1 | 0.58% |
Total | 4781 | 172 |
// SPDX-License-Identifier: GPL-2.0 // // Renesas R-Car SSIU/SSI support // // Copyright (C) 2013 Renesas Solutions Corp. // Kuninori Morimoto <kuninori.morimoto.gx@renesas.com> // // Based on fsi.c // Kuninori Morimoto <morimoto.kuninori@renesas.com> /* * you can enable below define if you don't need * SSI interrupt status debug message when debugging * see rsnd_print_irq_status() * * #define RSND_DEBUG_NO_IRQ_STATUS 1 */ #include <sound/simple_card_utils.h> #include <linux/of.h> #include <linux/of_irq.h> #include <linux/delay.h> #include "rsnd.h" #define RSND_SSI_NAME_SIZE 16 /* * SSICR */ #define FORCE (1u << 31) /* Fixed */ #define DMEN (1u << 28) /* DMA Enable */ #define UIEN (1u << 27) /* Underflow Interrupt Enable */ #define OIEN (1u << 26) /* Overflow Interrupt Enable */ #define IIEN (1u << 25) /* Idle Mode Interrupt Enable */ #define DIEN (1u << 24) /* Data Interrupt Enable */ #define CHNL_4 (1u << 22) /* Channels */ #define CHNL_6 (2u << 22) /* Channels */ #define CHNL_8 (3u << 22) /* Channels */ #define DWL_MASK (7u << 19) /* Data Word Length mask */ #define DWL_8 (0u << 19) /* Data Word Length */ #define DWL_16 (1u << 19) /* Data Word Length */ #define DWL_18 (2u << 19) /* Data Word Length */ #define DWL_20 (3u << 19) /* Data Word Length */ #define DWL_22 (4u << 19) /* Data Word Length */ #define DWL_24 (5u << 19) /* Data Word Length */ #define DWL_32 (6u << 19) /* Data Word Length */ /* * System word length */ #define SWL_16 (1 << 16) /* R/W System Word Length */ #define SWL_24 (2 << 16) /* R/W System Word Length */ #define SWL_32 (3 << 16) /* R/W System Word Length */ #define SCKD (1 << 15) /* Serial Bit Clock Direction */ #define SWSD (1 << 14) /* Serial WS Direction */ #define SCKP (1 << 13) /* Serial Bit Clock Polarity */ #define SWSP (1 << 12) /* Serial WS Polarity */ #define SDTA (1 << 10) /* Serial Data Alignment */ #define PDTA (1 << 9) /* Parallel Data Alignment */ #define DEL (1 << 8) /* Serial Data Delay */ #define CKDV(v) (v << 4) /* Serial Clock Division Ratio */ #define TRMD (1 << 1) /* Transmit/Receive Mode Select */ #define EN (1 << 0) /* SSI Module Enable */ /* * SSISR */ #define UIRQ (1 << 27) /* Underflow Error Interrupt Status */ #define OIRQ (1 << 26) /* Overflow Error Interrupt Status */ #define IIRQ (1 << 25) /* Idle Mode Interrupt Status */ #define DIRQ (1 << 24) /* Data Interrupt Status Flag */ /* * SSIWSR */ #define CONT (1 << 8) /* WS Continue Function */ #define WS_MODE (1 << 0) /* WS Mode */ #define SSI_NAME "ssi" struct rsnd_ssi { struct rsnd_mod mod; u32 flags; u32 cr_own; u32 cr_clk; u32 cr_mode; u32 cr_en; u32 wsr; int chan; int rate; int irq; unsigned int usrcnt; /* for PIO */ int byte_pos; int byte_per_period; int next_period_byte; }; /* flags */ #define RSND_SSI_CLK_PIN_SHARE (1 << 0) #define RSND_SSI_NO_BUSIF (1 << 1) /* SSI+DMA without BUSIF */ #define RSND_SSI_PROBED (1 << 2) #define for_each_rsnd_ssi(pos, priv, i) \ for (i = 0; \ (i < rsnd_ssi_nr(priv)) && \ ((pos) = ((struct rsnd_ssi *)(priv)->ssi + i)); \ i++) #define rsnd_ssi_get(priv, id) ((struct rsnd_ssi *)(priv->ssi) + id) #define rsnd_ssi_nr(priv) ((priv)->ssi_nr) #define rsnd_mod_to_ssi(_mod) container_of((_mod), struct rsnd_ssi, mod) #define rsnd_ssi_is_parent(ssi, io) ((ssi) == rsnd_io_to_mod_ssip(io)) #define rsnd_ssi_is_multi_secondary(mod, io) \ (rsnd_ssi_multi_secondaries(io) & (1 << rsnd_mod_id(mod))) #define rsnd_ssi_is_run_mods(mod, io) \ (rsnd_ssi_run_mods(io) & (1 << rsnd_mod_id(mod))) #define rsnd_ssi_can_output_clk(mod) (!__rsnd_ssi_is_pin_sharing(mod)) int rsnd_ssi_use_busif(struct rsnd_dai_stream *io) { struct rsnd_mod *mod = rsnd_io_to_mod_ssi(io); struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod); int use_busif = 0; if (!rsnd_ssi_is_dma_mode(mod)) return 0; if (!(rsnd_flags_has(ssi, RSND_SSI_NO_BUSIF))) use_busif = 1; if (rsnd_io_to_mod_src(io)) use_busif = 1; return use_busif; } static void rsnd_ssi_status_clear(struct rsnd_mod *mod) { rsnd_mod_write(mod, SSISR, 0); } static u32 rsnd_ssi_status_get(struct rsnd_mod *mod) { return rsnd_mod_read(mod, SSISR); } static void rsnd_ssi_status_check(struct rsnd_mod *mod, u32 bit) { struct rsnd_priv *priv = rsnd_mod_to_priv(mod); struct device *dev = rsnd_priv_to_dev(priv); u32 status; int i; for (i = 0; i < 1024; i++) { status = rsnd_ssi_status_get(mod); if (status & bit) return; udelay(5); } dev_warn(dev, "%s status check failed\n", rsnd_mod_name(mod)); } static u32 rsnd_ssi_multi_secondaries(struct rsnd_dai_stream *io) { static const enum rsnd_mod_type types[] = { RSND_MOD_SSIM1, RSND_MOD_SSIM2, RSND_MOD_SSIM3, }; int i, mask; mask = 0; for (i = 0; i < ARRAY_SIZE(types); i++) { struct rsnd_mod *mod = rsnd_io_to_mod(io, types[i]); if (!mod) continue; mask |= 1 << rsnd_mod_id(mod); } return mask; } static u32 rsnd_ssi_run_mods(struct rsnd_dai_stream *io) { struct rsnd_mod *ssi_mod = rsnd_io_to_mod_ssi(io); struct rsnd_mod *ssi_parent_mod = rsnd_io_to_mod_ssip(io); u32 mods; mods = rsnd_ssi_multi_secondaries_runtime(io) | 1 << rsnd_mod_id(ssi_mod); if (ssi_parent_mod) mods |= 1 << rsnd_mod_id(ssi_parent_mod); return mods; } u32 rsnd_ssi_multi_secondaries_runtime(struct rsnd_dai_stream *io) { if (rsnd_runtime_is_multi_ssi(io)) return rsnd_ssi_multi_secondaries(io); return 0; } static u32 rsnd_rdai_width_to_swl(struct rsnd_dai *rdai) { struct rsnd_priv *priv = rsnd_rdai_to_priv(rdai); struct device *dev = rsnd_priv_to_dev(priv); int width = rsnd_rdai_width_get(rdai); switch (width) { case 32: return SWL_32; case 24: return SWL_24; case 16: return SWL_16; } dev_err(dev, "unsupported slot width value: %d\n", width); return 0; } unsigned int rsnd_ssi_clk_query(struct rsnd_dai *rdai, int param1, int param2, int *idx) { struct rsnd_priv *priv = rsnd_rdai_to_priv(rdai); static const int ssi_clk_mul_table[] = { 1, 2, 4, 8, 16, 6, 12, }; int j, ret; unsigned int main_rate; int width = rsnd_rdai_width_get(rdai); for (j = 0; j < ARRAY_SIZE(ssi_clk_mul_table); j++) { /* * It will set SSIWSR.CONT here, but SSICR.CKDV = 000 * with it is not allowed. (SSIWSR.WS_MODE with * SSICR.CKDV = 000 is not allowed either). * Skip it. See SSICR.CKDV */ if (j == 0) continue; main_rate = width * param1 * param2 * ssi_clk_mul_table[j]; ret = rsnd_adg_clk_query(priv, main_rate); if (ret < 0) continue; if (idx) *idx = j; return main_rate; } return 0; } static int rsnd_ssi_master_clk_start(struct rsnd_mod *mod, struct rsnd_dai_stream *io) { struct rsnd_priv *priv = rsnd_io_to_priv(io); struct device *dev = rsnd_priv_to_dev(priv); struct rsnd_dai *rdai = rsnd_io_to_rdai(io); struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod); int chan = rsnd_runtime_channel_for_ssi(io); int idx, ret; unsigned int main_rate; unsigned int rate = rsnd_io_is_play(io) ? rsnd_src_get_out_rate(priv, io) : rsnd_src_get_in_rate(priv, io); if (!rsnd_rdai_is_clk_master(rdai)) return 0; if (!rsnd_ssi_can_output_clk(mod)) return 0; if (rsnd_ssi_is_multi_secondary(mod, io)) return 0; if (rsnd_runtime_is_tdm_split(io)) chan = rsnd_io_converted_chan(io); chan = rsnd_channel_normalization(chan); if (ssi->usrcnt > 0) { if (ssi->rate != rate) { dev_err(dev, "SSI parent/child should use same rate\n"); return -EINVAL; } if (ssi->chan != chan) { dev_err(dev, "SSI parent/child should use same chan\n"); return -EINVAL; } return 0; } ret = -EIO; main_rate = rsnd_ssi_clk_query(rdai, rate, chan, &idx); if (!main_rate) goto rate_err; ret = rsnd_adg_ssi_clk_try_start(mod, main_rate); if (ret < 0) goto rate_err; /* * SSI clock will be output contiguously * by below settings. * This means, rsnd_ssi_master_clk_start() * and rsnd_ssi_register_setup() are necessary * for SSI parent * * SSICR : FORCE, SCKD, SWSD * SSIWSR : CONT */ ssi->cr_clk = FORCE | rsnd_rdai_width_to_swl(rdai) | SCKD | SWSD | CKDV(idx); ssi->wsr = CONT; ssi->rate = rate; ssi->chan = chan; dev_dbg(dev, "%s outputs %d chan %u Hz\n", rsnd_mod_name(mod), chan, rate); return 0; rate_err: dev_err(dev, "unsupported clock rate\n"); return ret; } static void rsnd_ssi_master_clk_stop(struct rsnd_mod *mod, struct rsnd_dai_stream *io) { struct rsnd_dai *rdai = rsnd_io_to_rdai(io); struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod); if (!rsnd_rdai_is_clk_master(rdai)) return; if (!rsnd_ssi_can_output_clk(mod)) return; if (ssi->usrcnt > 1) return; ssi->cr_clk = 0; ssi->rate = 0; ssi->chan = 0; rsnd_adg_ssi_clk_stop(mod); } static void rsnd_ssi_config_init(struct rsnd_mod *mod, struct rsnd_dai_stream *io) { struct rsnd_dai *rdai = rsnd_io_to_rdai(io); struct rsnd_priv *priv = rsnd_rdai_to_priv(rdai); struct device *dev = rsnd_priv_to_dev(priv); struct snd_pcm_runtime *runtime = rsnd_io_to_runtime(io); struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod); u32 cr_own = ssi->cr_own; u32 cr_mode = ssi->cr_mode; u32 wsr = ssi->wsr; int width; int is_tdm, is_tdm_split; is_tdm = rsnd_runtime_is_tdm(io); is_tdm_split = rsnd_runtime_is_tdm_split(io); if (is_tdm) dev_dbg(dev, "TDM mode\n"); if (is_tdm_split) dev_dbg(dev, "TDM Split mode\n"); cr_own |= FORCE | rsnd_rdai_width_to_swl(rdai); if (rdai->bit_clk_inv) cr_own |= SCKP; if (rdai->frm_clk_inv && !is_tdm) cr_own |= SWSP; if (rdai->data_alignment) cr_own |= SDTA; if (rdai->sys_delay) cr_own |= DEL; /* * TDM Mode * see * rsnd_ssiu_init_gen2() */ if (is_tdm || is_tdm_split) { wsr |= WS_MODE; cr_own |= CHNL_8; } /* * We shouldn't exchange SWSP after running. * This means, parent needs to care it. */ if (rsnd_ssi_is_parent(mod, io)) goto init_end; if (rsnd_io_is_play(io)) cr_own |= TRMD; cr_own &= ~DWL_MASK; width = snd_pcm_format_width(runtime->format); if (is_tdm_split) { /* * The SWL and DWL bits in SSICR should be fixed at 32-bit * setting when TDM split mode. * see datasheet * Operation :: TDM Format Split Function (TDM Split Mode) */ width = 32; } switch (width) { case 8: cr_own |= DWL_8; break; case 16: cr_own |= DWL_16; break; case 24: cr_own |= DWL_24; break; case 32: cr_own |= DWL_32; break; } if (rsnd_ssi_is_dma_mode(mod)) { cr_mode = UIEN | OIEN | /* over/under run */ DMEN; /* DMA : enable DMA */ } else { cr_mode = DIEN; /* PIO : enable Data interrupt */ } init_end: ssi->cr_own = cr_own; ssi->cr_mode = cr_mode; ssi->wsr = wsr; } static void rsnd_ssi_register_setup(struct rsnd_mod *mod) { struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod); rsnd_mod_write(mod, SSIWSR, ssi->wsr); rsnd_mod_write(mod, SSICR, ssi->cr_own | ssi->cr_clk | ssi->cr_mode | ssi->cr_en); } /* * SSI mod common functions */ static int rsnd_ssi_init(struct rsnd_mod *mod, struct rsnd_dai_stream *io, struct rsnd_priv *priv) { struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod); int ret; if (!rsnd_ssi_is_run_mods(mod, io)) return 0; ret = rsnd_ssi_master_clk_start(mod, io); if (ret < 0) return ret; ssi->usrcnt++; ret = rsnd_mod_power_on(mod); if (ret < 0) return ret; rsnd_ssi_config_init(mod, io); rsnd_ssi_register_setup(mod); /* clear error status */ rsnd_ssi_status_clear(mod); return 0; } static int rsnd_ssi_quit(struct rsnd_mod *mod, struct rsnd_dai_stream *io, struct rsnd_priv *priv) { struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod); struct device *dev = rsnd_priv_to_dev(priv); if (!rsnd_ssi_is_run_mods(mod, io)) return 0; if (!ssi->usrcnt) { dev_err(dev, "%s usrcnt error\n", rsnd_mod_name(mod)); return -EIO; } rsnd_ssi_master_clk_stop(mod, io); rsnd_mod_power_off(mod); ssi->usrcnt--; if (!ssi->usrcnt) { ssi->cr_own = 0; ssi->cr_mode = 0; ssi->wsr = 0; } return 0; } static int rsnd_ssi_hw_params(struct rsnd_mod *mod, struct rsnd_dai_stream *io, struct snd_pcm_substream *substream, struct snd_pcm_hw_params *params) { struct rsnd_dai *rdai = rsnd_io_to_rdai(io); unsigned int fmt_width = snd_pcm_format_width(params_format(params)); if (fmt_width > rdai->chan_width) { struct rsnd_priv *priv = rsnd_io_to_priv(io); struct device *dev = rsnd_priv_to_dev(priv); dev_err(dev, "invalid combination of slot-width and format-data-width\n"); return -EINVAL; } return 0; } static int rsnd_ssi_start(struct rsnd_mod *mod, struct rsnd_dai_stream *io, struct rsnd_priv *priv) { struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod); if (!rsnd_ssi_is_run_mods(mod, io)) return 0; /* * EN will be set via SSIU :: SSI_CONTROL * if Multi channel mode */ if (rsnd_ssi_multi_secondaries_runtime(io)) return 0; /* * EN is for data output. * SSI parent EN is not needed. */ if (rsnd_ssi_is_parent(mod, io)) return 0; ssi->cr_en = EN; rsnd_mod_write(mod, SSICR, ssi->cr_own | ssi->cr_clk | ssi->cr_mode | ssi->cr_en); return 0; } static int rsnd_ssi_stop(struct rsnd_mod *mod, struct rsnd_dai_stream *io, struct rsnd_priv *priv) { struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod); u32 cr; if (!rsnd_ssi_is_run_mods(mod, io)) return 0; if (rsnd_ssi_is_parent(mod, io)) return 0; cr = ssi->cr_own | ssi->cr_clk; /* * disable all IRQ, * Playback: Wait all data was sent * Capture: It might not receave data. Do nothing */ if (rsnd_io_is_play(io)) { rsnd_mod_write(mod, SSICR, cr | ssi->cr_en); rsnd_ssi_status_check(mod, DIRQ); } /* In multi-SSI mode, stop is performed by setting ssi0129 in * SSI_CONTROL to 0 (in rsnd_ssio_stop_gen2). Do nothing here. */ if (rsnd_ssi_multi_secondaries_runtime(io)) return 0; /* * disable SSI, * and, wait idle state */ rsnd_mod_write(mod, SSICR, cr); /* disabled all */ rsnd_ssi_status_check(mod, IIRQ); ssi->cr_en = 0; return 0; } static int rsnd_ssi_irq(struct rsnd_mod *mod, struct rsnd_dai_stream *io, struct rsnd_priv *priv, int enable) { u32 val = 0; int is_tdm, is_tdm_split; int id = rsnd_mod_id(mod); is_tdm = rsnd_runtime_is_tdm(io); is_tdm_split = rsnd_runtime_is_tdm_split(io); if (rsnd_is_gen1(priv)) return 0; if (rsnd_ssi_is_parent(mod, io)) return 0; if (!rsnd_ssi_is_run_mods(mod, io)) return 0; if (enable) val = rsnd_ssi_is_dma_mode(mod) ? 0x0e000000 : 0x0f000000; if (is_tdm || is_tdm_split) { switch (id) { case 0: case 1: case 2: case 3: case 4: case 9: val |= 0x0000ff00; break; } } rsnd_mod_write(mod, SSI_INT_ENABLE, val); return 0; } static bool rsnd_ssi_pio_interrupt(struct rsnd_mod *mod, struct rsnd_dai_stream *io); static void __rsnd_ssi_interrupt(struct rsnd_mod *mod, struct rsnd_dai_stream *io) { struct rsnd_priv *priv = rsnd_mod_to_priv(mod); struct device *dev = rsnd_priv_to_dev(priv); int is_dma = rsnd_ssi_is_dma_mode(mod); u32 status; bool elapsed = false; bool stop = false; spin_lock(&priv->lock); /* ignore all cases if not working */ if (!rsnd_io_is_working(io)) goto rsnd_ssi_interrupt_out; status = rsnd_ssi_status_get(mod); /* PIO only */ if (!is_dma && (status & DIRQ)) elapsed = rsnd_ssi_pio_interrupt(mod, io); /* DMA only */ if (is_dma && (status & (UIRQ | OIRQ))) { rsnd_print_irq_status(dev, "%s err status : 0x%08x\n", rsnd_mod_name(mod), status); stop = true; } stop |= rsnd_ssiu_busif_err_status_clear(mod); rsnd_ssi_status_clear(mod); rsnd_ssi_interrupt_out: spin_unlock(&priv->lock); if (elapsed) rsnd_dai_period_elapsed(io); if (stop) snd_pcm_stop_xrun(io->substream); } static irqreturn_t rsnd_ssi_interrupt(int irq, void *data) { struct rsnd_mod *mod = data; rsnd_mod_interrupt(mod, __rsnd_ssi_interrupt); return IRQ_HANDLED; } static u32 *rsnd_ssi_get_status(struct rsnd_mod *mod, struct rsnd_dai_stream *io, enum rsnd_mod_type type) { /* * SSIP (= SSI parent) needs to be special, otherwise, * 2nd SSI might doesn't start. see also rsnd_mod_call() * * We can't include parent SSI status on SSI, because we don't know * how many SSI requests parent SSI. Thus, it is localed on "io" now. * ex) trouble case * Playback: SSI0 * Capture : SSI1 (needs SSI0) * * 1) start Capture -> SSI0/SSI1 are started. * 2) start Playback -> SSI0 doesn't work, because it is already * marked as "started" on 1) * * OTOH, using each mod's status is good for MUX case. * It doesn't need to start in 2nd start * ex) * IO-0: SRC0 -> CTU1 -+-> MUX -> DVC -> SSIU -> SSI0 * | * IO-1: SRC1 -> CTU2 -+ * * 1) start IO-0 -> start SSI0 * 2) start IO-1 -> SSI0 doesn't need to start, because it is * already started on 1) */ if (type == RSND_MOD_SSIP) return &io->parent_ssi_status; return rsnd_mod_get_status(mod, io, type); } /* * SSI PIO */ static void rsnd_ssi_parent_attach(struct rsnd_mod *mod, struct rsnd_dai_stream *io) { struct rsnd_dai *rdai = rsnd_io_to_rdai(io); struct rsnd_priv *priv = rsnd_mod_to_priv(mod); if (!__rsnd_ssi_is_pin_sharing(mod)) return; if (!rsnd_rdai_is_clk_master(rdai)) return; if (rsnd_ssi_is_multi_secondary(mod, io)) return; switch (rsnd_mod_id(mod)) { case 1: case 2: case 9: rsnd_dai_connect(rsnd_ssi_mod_get(priv, 0), io, RSND_MOD_SSIP); break; case 4: rsnd_dai_connect(rsnd_ssi_mod_get(priv, 3), io, RSND_MOD_SSIP); break; case 8: rsnd_dai_connect(rsnd_ssi_mod_get(priv, 7), io, RSND_MOD_SSIP); break; } } static int rsnd_ssi_pcm_new(struct rsnd_mod *mod, struct rsnd_dai_stream *io, struct snd_soc_pcm_runtime *rtd) { /* * rsnd_rdai_is_clk_master() will be enabled after set_fmt, * and, pcm_new will be called after it. * This function reuse pcm_new at this point. */ rsnd_ssi_parent_attach(mod, io); return 0; } static int rsnd_ssi_common_probe(struct rsnd_mod *mod, struct rsnd_dai_stream *io, struct rsnd_priv *priv) { struct device *dev = rsnd_priv_to_dev(priv); struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod); int ret = 0; /* * SSIP/SSIU/IRQ are not needed on * SSI Multi secondaries */ if (rsnd_ssi_is_multi_secondary(mod, io)) return 0; /* * It can't judge ssi parent at this point * see rsnd_ssi_pcm_new() */ /* * SSI might be called again as PIO fallback * It is easy to manual handling for IRQ request/free * * OTOH, this function might be called many times if platform is * using MIX. It needs xxx_attach() many times on xxx_probe(). * Because of it, we can't control .probe/.remove calling count by * mod->status. * But it don't need to call request_irq() many times. * Let's control it by RSND_SSI_PROBED flag. */ if (!rsnd_flags_has(ssi, RSND_SSI_PROBED)) { ret = request_irq(ssi->irq, rsnd_ssi_interrupt, IRQF_SHARED, dev_name(dev), mod); rsnd_flags_set(ssi, RSND_SSI_PROBED); } return ret; } static int rsnd_ssi_common_remove(struct rsnd_mod *mod, struct rsnd_dai_stream *io, struct rsnd_priv *priv) { struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod); struct rsnd_mod *pure_ssi_mod = rsnd_io_to_mod_ssi(io); /* Do nothing if non SSI (= SSI parent, multi SSI) mod */ if (pure_ssi_mod != mod) return 0; /* PIO will request IRQ again */ if (rsnd_flags_has(ssi, RSND_SSI_PROBED)) { free_irq(ssi->irq, mod); rsnd_flags_del(ssi, RSND_SSI_PROBED); } return 0; } /* * SSI PIO functions */ static bool rsnd_ssi_pio_interrupt(struct rsnd_mod *mod, struct rsnd_dai_stream *io) { struct snd_pcm_runtime *runtime = rsnd_io_to_runtime(io); struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod); u32 *buf = (u32 *)(runtime->dma_area + ssi->byte_pos); int shift = 0; int byte_pos; bool elapsed = false; if (snd_pcm_format_width(runtime->format) == 24) shift = 8; /* * 8/16/32 data can be assesse to TDR/RDR register * directly as 32bit data * see rsnd_ssi_init() */ if (rsnd_io_is_play(io)) rsnd_mod_write(mod, SSITDR, (*buf) << shift); else *buf = (rsnd_mod_read(mod, SSIRDR) >> shift); byte_pos = ssi->byte_pos + sizeof(*buf); if (byte_pos >= ssi->next_period_byte) { int period_pos = byte_pos / ssi->byte_per_period; if (period_pos >= runtime->periods) { byte_pos = 0; period_pos = 0; } ssi->next_period_byte = (period_pos + 1) * ssi->byte_per_period; elapsed = true; } WRITE_ONCE(ssi->byte_pos, byte_pos); return elapsed; } static int rsnd_ssi_pio_init(struct rsnd_mod *mod, struct rsnd_dai_stream *io, struct rsnd_priv *priv) { struct snd_pcm_runtime *runtime = rsnd_io_to_runtime(io); struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod); if (!rsnd_ssi_is_parent(mod, io)) { ssi->byte_pos = 0; ssi->byte_per_period = runtime->period_size * runtime->channels * samples_to_bytes(runtime, 1); ssi->next_period_byte = ssi->byte_per_period; } return rsnd_ssi_init(mod, io, priv); } static int rsnd_ssi_pio_pointer(struct rsnd_mod *mod, struct rsnd_dai_stream *io, snd_pcm_uframes_t *pointer) { struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod); struct snd_pcm_runtime *runtime = rsnd_io_to_runtime(io); *pointer = bytes_to_frames(runtime, READ_ONCE(ssi->byte_pos)); return 0; } static struct rsnd_mod_ops rsnd_ssi_pio_ops = { .name = SSI_NAME, .probe = rsnd_ssi_common_probe, .remove = rsnd_ssi_common_remove, .init = rsnd_ssi_pio_init, .quit = rsnd_ssi_quit, .start = rsnd_ssi_start, .stop = rsnd_ssi_stop, .irq = rsnd_ssi_irq, .pointer = rsnd_ssi_pio_pointer, .pcm_new = rsnd_ssi_pcm_new, .hw_params = rsnd_ssi_hw_params, .get_status = rsnd_ssi_get_status, }; static int rsnd_ssi_dma_probe(struct rsnd_mod *mod, struct rsnd_dai_stream *io, struct rsnd_priv *priv) { int ret; /* * SSIP/SSIU/IRQ/DMA are not needed on * SSI Multi secondaries */ if (rsnd_ssi_is_multi_secondary(mod, io)) return 0; ret = rsnd_ssi_common_probe(mod, io, priv); if (ret) return ret; /* SSI probe might be called many times in MUX multi path */ ret = rsnd_dma_attach(io, mod, &io->dma); return ret; } static int rsnd_ssi_fallback(struct rsnd_mod *mod, struct rsnd_dai_stream *io, struct rsnd_priv *priv) { struct device *dev = rsnd_priv_to_dev(priv); /* * fallback to PIO * * SSI .probe might be called again. * see * rsnd_rdai_continuance_probe() */ mod->ops = &rsnd_ssi_pio_ops; dev_info(dev, "%s fallback to PIO mode\n", rsnd_mod_name(mod)); return 0; } static struct dma_chan *rsnd_ssi_dma_req(struct rsnd_dai_stream *io, struct rsnd_mod *mod) { struct rsnd_priv *priv = rsnd_mod_to_priv(mod); int is_play = rsnd_io_is_play(io); char *name; /* * It should use "rcar_sound,ssiu" on DT. * But, we need to keep compatibility for old version. * * If it has "rcar_sound.ssiu", it will be used. * If not, "rcar_sound.ssi" will be used. * see * rsnd_ssiu_dma_req() * rsnd_dma_of_path() */ if (rsnd_ssi_use_busif(io)) name = is_play ? "rxu" : "txu"; else name = is_play ? "rx" : "tx"; return rsnd_dma_request_channel(rsnd_ssi_of_node(priv), SSI_NAME, mod, name); } #ifdef CONFIG_DEBUG_FS static void rsnd_ssi_debug_info(struct seq_file *m, struct rsnd_dai_stream *io, struct rsnd_mod *mod) { struct rsnd_dai *rdai = rsnd_io_to_rdai(io); struct rsnd_ssi *ssi = rsnd_mod_to_ssi(mod); seq_printf(m, "clock: %s\n", rsnd_rdai_is_clk_master(rdai) ? "provider" : "consumer"); seq_printf(m, "bit_clk_inv: %d\n", rdai->bit_clk_inv); seq_printf(m, "frm_clk_inv: %d\n", rdai->frm_clk_inv); seq_printf(m, "pin share: %d\n", __rsnd_ssi_is_pin_sharing(mod)); seq_printf(m, "can out clk: %d\n", rsnd_ssi_can_output_clk(mod)); seq_printf(m, "multi secondary: %d\n", rsnd_ssi_is_multi_secondary(mod, io)); seq_printf(m, "tdm: %d, %d\n", rsnd_runtime_is_tdm(io), rsnd_runtime_is_tdm_split(io)); seq_printf(m, "chan: %d\n", ssi->chan); seq_printf(m, "user: %d\n", ssi->usrcnt); rsnd_debugfs_mod_reg_show(m, mod, RSND_GEN2_SSI, rsnd_mod_id(mod) * 0x40, 0x40); } #define DEBUG_INFO .debug_info = rsnd_ssi_debug_info #else #define DEBUG_INFO #endif static struct rsnd_mod_ops rsnd_ssi_dma_ops = { .name = SSI_NAME, .dma_req = rsnd_ssi_dma_req, .probe = rsnd_ssi_dma_probe, .remove = rsnd_ssi_common_remove, .init = rsnd_ssi_init, .quit = rsnd_ssi_quit, .start = rsnd_ssi_start, .stop = rsnd_ssi_stop, .irq = rsnd_ssi_irq, .pcm_new = rsnd_ssi_pcm_new, .fallback = rsnd_ssi_fallback, .hw_params = rsnd_ssi_hw_params, .get_status = rsnd_ssi_get_status, DEBUG_INFO }; int rsnd_ssi_is_dma_mode(struct rsnd_mod *mod) { return mod->ops == &rsnd_ssi_dma_ops; } /* * ssi mod function */ static void rsnd_ssi_connect(struct rsnd_mod *mod, struct rsnd_dai_stream *io) { struct rsnd_dai *rdai = rsnd_io_to_rdai(io); static const enum rsnd_mod_type types[] = { RSND_MOD_SSI, RSND_MOD_SSIM1, RSND_MOD_SSIM2, RSND_MOD_SSIM3, }; enum rsnd_mod_type type; int i; /* try SSI -> SSIM1 -> SSIM2 -> SSIM3 */ for (i = 0; i < ARRAY_SIZE(types); i++) { type = types[i]; if (!rsnd_io_to_mod(io, type)) { rsnd_dai_connect(mod, io, type); rsnd_rdai_channels_set(rdai, (i + 1) * 2); rsnd_rdai_ssi_lane_set(rdai, (i + 1)); return; } } } void rsnd_parse_connect_ssi(struct rsnd_dai *rdai, struct device_node *playback, struct device_node *capture) { struct rsnd_priv *priv = rsnd_rdai_to_priv(rdai); struct device *dev = rsnd_priv_to_dev(priv); struct device_node *node; struct device_node *np; int i; node = rsnd_ssi_of_node(priv); if (!node) return; i = 0; for_each_child_of_node(node, np) { struct rsnd_mod *mod; i = rsnd_node_fixed_index(dev, np, SSI_NAME, i); if (i < 0) { of_node_put(np); break; } mod = rsnd_ssi_mod_get(priv, i); if (np == playback) rsnd_ssi_connect(mod, &rdai->playback); if (np == capture) rsnd_ssi_connect(mod, &rdai->capture); i++; } of_node_put(node); } struct rsnd_mod *rsnd_ssi_mod_get(struct rsnd_priv *priv, int id) { if (WARN_ON(id < 0 || id >= rsnd_ssi_nr(priv))) id = 0; return rsnd_mod_get(rsnd_ssi_get(priv, id)); } int __rsnd_ssi_is_pin_sharing(struct rsnd_mod *mod) { if (!mod) return 0; return !!(rsnd_flags_has(rsnd_mod_to_ssi(mod), RSND_SSI_CLK_PIN_SHARE)); } int rsnd_ssi_probe(struct rsnd_priv *priv) { struct device_node *node; struct device_node *np; struct device *dev = rsnd_priv_to_dev(priv); struct rsnd_mod_ops *ops; struct clk *clk; struct rsnd_ssi *ssi; char name[RSND_SSI_NAME_SIZE]; int i, nr, ret; node = rsnd_ssi_of_node(priv); if (!node) return -EINVAL; nr = rsnd_node_count(priv, node, SSI_NAME); if (!nr) { ret = -EINVAL; goto rsnd_ssi_probe_done; } ssi = devm_kcalloc(dev, nr, sizeof(*ssi), GFP_KERNEL); if (!ssi) { ret = -ENOMEM; goto rsnd_ssi_probe_done; } priv->ssi = ssi; priv->ssi_nr = nr; i = 0; for_each_child_of_node(node, np) { if (!of_device_is_available(np)) goto skip; i = rsnd_node_fixed_index(dev, np, SSI_NAME, i); if (i < 0) { ret = -EINVAL; of_node_put(np); goto rsnd_ssi_probe_done; } ssi = rsnd_ssi_get(priv, i); snprintf(name, RSND_SSI_NAME_SIZE, "%s.%d", SSI_NAME, i); clk = devm_clk_get(dev, name); if (IS_ERR(clk)) { ret = PTR_ERR(clk); of_node_put(np); goto rsnd_ssi_probe_done; } if (of_property_read_bool(np, "shared-pin")) rsnd_flags_set(ssi, RSND_SSI_CLK_PIN_SHARE); if (of_property_read_bool(np, "no-busif")) rsnd_flags_set(ssi, RSND_SSI_NO_BUSIF); ssi->irq = irq_of_parse_and_map(np, 0); if (!ssi->irq) { ret = -EINVAL; of_node_put(np); goto rsnd_ssi_probe_done; } if (of_property_read_bool(np, "pio-transfer")) ops = &rsnd_ssi_pio_ops; else ops = &rsnd_ssi_dma_ops; ret = rsnd_mod_init(priv, rsnd_mod_get(ssi), ops, clk, RSND_MOD_SSI, i); if (ret) { of_node_put(np); goto rsnd_ssi_probe_done; } skip: i++; } ret = 0; rsnd_ssi_probe_done: of_node_put(node); return ret; } void rsnd_ssi_remove(struct rsnd_priv *priv) { struct rsnd_ssi *ssi; int i; for_each_rsnd_ssi(ssi, priv, i) { rsnd_mod_quit(rsnd_mod_get(ssi)); } }
Information contained on this website is for historical information purposes only and does not indicate or represent copyright ownership.
Created with Cregit http://github.com/cregit/cregit
Version 2.0-RC1