2019-01-04 09:17:38 +00:00
// SPDX-License-Identifier: GPL-2.0
// Copyright 2018 NXP
2022-04-14 18:22:33 +02:00
# include <linux/bitfield.h>
2019-01-04 09:17:38 +00:00
# include <linux/clk.h>
# include <linux/device.h>
# include <linux/interrupt.h>
# include <linux/kobject.h>
# include <linux/kernel.h>
# include <linux/module.h>
# include <linux/of.h>
# include <linux/of_address.h>
# include <linux/of_irq.h>
# include <linux/of_platform.h>
# include <linux/pm_runtime.h>
# include <linux/regmap.h>
# include <linux/sysfs.h>
# include <linux/types.h>
2022-04-14 18:22:40 +02:00
# include <linux/dma/imx-dma.h>
2019-01-04 09:17:38 +00:00
# include <sound/dmaengine_pcm.h>
# include <sound/pcm.h>
# include <sound/soc.h>
# include <sound/tlv.h>
# include <sound/core.h>
# include "fsl_micfil.h"
# define FSL_MICFIL_RATES SNDRV_PCM_RATE_8000_48000
# define FSL_MICFIL_FORMATS (SNDRV_PCM_FMTBIT_S16_LE)
2022-04-14 18:22:41 +02:00
# define MICFIL_OSR_DEFAULT 16
2022-04-14 18:22:44 +02:00
enum quality {
QUALITY_HIGH ,
QUALITY_MEDIUM ,
QUALITY_LOW ,
QUALITY_VLOW0 ,
QUALITY_VLOW1 ,
QUALITY_VLOW2 ,
} ;
2019-01-04 09:17:38 +00:00
struct fsl_micfil {
struct platform_device * pdev ;
struct regmap * regmap ;
const struct fsl_micfil_soc_data * soc ;
2021-03-24 17:58:48 +08:00
struct clk * busclk ;
2019-01-04 09:17:38 +00:00
struct clk * mclk ;
struct snd_dmaengine_dai_dma_data dma_params_rx ;
2022-04-14 18:22:40 +02:00
struct sdma_peripheral_config sdmacfg ;
2019-01-04 09:17:38 +00:00
unsigned int dataline ;
char name [ 32 ] ;
int irq [ MICFIL_IRQ_LINES ] ;
2022-04-14 18:22:44 +02:00
enum quality quality ;
2019-01-04 09:17:38 +00:00
} ;
struct fsl_micfil_soc_data {
unsigned int fifos ;
unsigned int fifo_depth ;
unsigned int dataline ;
bool imx ;
} ;
static struct fsl_micfil_soc_data fsl_micfil_imx8mm = {
. imx = true ,
. fifos = 8 ,
. fifo_depth = 8 ,
. dataline = 0xf ,
} ;
static const struct of_device_id fsl_micfil_dt_ids [ ] = {
{ . compatible = " fsl,imx8mm-micfil " , . data = & fsl_micfil_imx8mm } ,
{ }
} ;
MODULE_DEVICE_TABLE ( of , fsl_micfil_dt_ids ) ;
static const char * const micfil_quality_select_texts [ ] = {
2022-04-14 18:22:44 +02:00
[ QUALITY_HIGH ] = " High " ,
[ QUALITY_MEDIUM ] = " Medium " ,
[ QUALITY_LOW ] = " Low " ,
[ QUALITY_VLOW0 ] = " VLow0 " ,
[ QUALITY_VLOW1 ] = " Vlow1 " ,
[ QUALITY_VLOW2 ] = " Vlow2 " ,
2019-01-04 09:17:38 +00:00
} ;
static const struct soc_enum fsl_micfil_quality_enum =
2022-04-14 18:22:44 +02:00
SOC_ENUM_SINGLE_EXT ( ARRAY_SIZE ( micfil_quality_select_texts ) ,
micfil_quality_select_texts ) ;
2019-01-04 09:17:38 +00:00
static DECLARE_TLV_DB_SCALE ( gain_tlv , 0 , 100 , 0 ) ;
2022-04-14 18:22:44 +02:00
static int micfil_set_quality ( struct fsl_micfil * micfil )
{
u32 qsel ;
switch ( micfil - > quality ) {
case QUALITY_HIGH :
qsel = MICFIL_QSEL_HIGH_QUALITY ;
break ;
case QUALITY_MEDIUM :
qsel = MICFIL_QSEL_MEDIUM_QUALITY ;
break ;
case QUALITY_LOW :
qsel = MICFIL_QSEL_LOW_QUALITY ;
break ;
case QUALITY_VLOW0 :
qsel = MICFIL_QSEL_VLOW0_QUALITY ;
break ;
case QUALITY_VLOW1 :
qsel = MICFIL_QSEL_VLOW1_QUALITY ;
break ;
case QUALITY_VLOW2 :
qsel = MICFIL_QSEL_VLOW2_QUALITY ;
break ;
}
return regmap_update_bits ( micfil - > regmap , REG_MICFIL_CTRL2 ,
MICFIL_CTRL2_QSEL ,
FIELD_PREP ( MICFIL_CTRL2_QSEL , qsel ) ) ;
}
static int micfil_quality_get ( struct snd_kcontrol * kcontrol ,
struct snd_ctl_elem_value * ucontrol )
{
struct snd_soc_component * cmpnt = snd_soc_kcontrol_component ( kcontrol ) ;
struct fsl_micfil * micfil = snd_soc_component_get_drvdata ( cmpnt ) ;
ucontrol - > value . integer . value [ 0 ] = micfil - > quality ;
return 0 ;
}
static int micfil_quality_set ( struct snd_kcontrol * kcontrol ,
struct snd_ctl_elem_value * ucontrol )
{
struct snd_soc_component * cmpnt = snd_soc_kcontrol_component ( kcontrol ) ;
struct fsl_micfil * micfil = snd_soc_component_get_drvdata ( cmpnt ) ;
micfil - > quality = ucontrol - > value . integer . value [ 0 ] ;
return micfil_set_quality ( micfil ) ;
}
2019-01-04 09:17:38 +00:00
static const struct snd_kcontrol_new fsl_micfil_snd_controls [ ] = {
SOC_SINGLE_SX_TLV ( " CH0 Volume " , REG_MICFIL_OUT_CTRL ,
MICFIL_OUTGAIN_CHX_SHIFT ( 0 ) , 0xF , 0x7 , gain_tlv ) ,
SOC_SINGLE_SX_TLV ( " CH1 Volume " , REG_MICFIL_OUT_CTRL ,
MICFIL_OUTGAIN_CHX_SHIFT ( 1 ) , 0xF , 0x7 , gain_tlv ) ,
SOC_SINGLE_SX_TLV ( " CH2 Volume " , REG_MICFIL_OUT_CTRL ,
MICFIL_OUTGAIN_CHX_SHIFT ( 2 ) , 0xF , 0x7 , gain_tlv ) ,
SOC_SINGLE_SX_TLV ( " CH3 Volume " , REG_MICFIL_OUT_CTRL ,
MICFIL_OUTGAIN_CHX_SHIFT ( 3 ) , 0xF , 0x7 , gain_tlv ) ,
SOC_SINGLE_SX_TLV ( " CH4 Volume " , REG_MICFIL_OUT_CTRL ,
MICFIL_OUTGAIN_CHX_SHIFT ( 4 ) , 0xF , 0x7 , gain_tlv ) ,
SOC_SINGLE_SX_TLV ( " CH5 Volume " , REG_MICFIL_OUT_CTRL ,
MICFIL_OUTGAIN_CHX_SHIFT ( 5 ) , 0xF , 0x7 , gain_tlv ) ,
SOC_SINGLE_SX_TLV ( " CH6 Volume " , REG_MICFIL_OUT_CTRL ,
MICFIL_OUTGAIN_CHX_SHIFT ( 6 ) , 0xF , 0x7 , gain_tlv ) ,
SOC_SINGLE_SX_TLV ( " CH7 Volume " , REG_MICFIL_OUT_CTRL ,
MICFIL_OUTGAIN_CHX_SHIFT ( 7 ) , 0xF , 0x7 , gain_tlv ) ,
SOC_ENUM_EXT ( " MICFIL Quality Select " ,
fsl_micfil_quality_enum ,
2022-04-14 18:22:44 +02:00
micfil_quality_get , micfil_quality_set ) ,
2019-01-04 09:17:38 +00:00
} ;
/* The SRES is a self-negated bit which provides the CPU with the
* capability to initialize the PDM Interface module through the
* slave - bus interface . This bit always reads as zero , and this
* bit is only effective when MDIS is cleared
*/
static int fsl_micfil_reset ( struct device * dev )
{
struct fsl_micfil * micfil = dev_get_drvdata ( dev ) ;
int ret ;
2022-04-14 18:22:34 +02:00
ret = regmap_clear_bits ( micfil - > regmap , REG_MICFIL_CTRL1 ,
MICFIL_CTRL1_MDIS ) ;
2022-04-14 18:22:35 +02:00
if ( ret )
2019-01-04 09:17:38 +00:00
return ret ;
2022-04-14 18:22:34 +02:00
ret = regmap_set_bits ( micfil - > regmap , REG_MICFIL_CTRL1 ,
MICFIL_CTRL1_SRES ) ;
2022-04-14 18:22:35 +02:00
if ( ret )
2019-01-04 09:17:38 +00:00
return ret ;
return 0 ;
}
static int fsl_micfil_startup ( struct snd_pcm_substream * substream ,
struct snd_soc_dai * dai )
{
struct fsl_micfil * micfil = snd_soc_dai_get_drvdata ( dai ) ;
if ( ! micfil ) {
2020-05-18 18:59:51 +08:00
dev_err ( dai - > dev , " micfil dai priv_data not set \n " ) ;
2019-01-04 09:17:38 +00:00
return - EINVAL ;
}
return 0 ;
}
static int fsl_micfil_trigger ( struct snd_pcm_substream * substream , int cmd ,
struct snd_soc_dai * dai )
{
struct fsl_micfil * micfil = snd_soc_dai_get_drvdata ( dai ) ;
struct device * dev = & micfil - > pdev - > dev ;
int ret ;
switch ( cmd ) {
case SNDRV_PCM_TRIGGER_START :
case SNDRV_PCM_TRIGGER_RESUME :
case SNDRV_PCM_TRIGGER_PAUSE_RELEASE :
ret = fsl_micfil_reset ( dev ) ;
if ( ret ) {
dev_err ( dev , " failed to soft reset \n " ) ;
return ret ;
}
/* DMA Interrupt Selection - DISEL bits
* 00 - DMA and IRQ disabled
* 01 - DMA req enabled
* 10 - IRQ enabled
* 11 - reserved
*/
ret = regmap_update_bits ( micfil - > regmap , REG_MICFIL_CTRL1 ,
2022-04-14 18:22:33 +02:00
MICFIL_CTRL1_DISEL ,
FIELD_PREP ( MICFIL_CTRL1_DISEL , MICFIL_CTRL1_DISEL_DMA ) ) ;
2022-04-14 18:22:35 +02:00
if ( ret )
2019-01-04 09:17:38 +00:00
return ret ;
/* Enable the module */
2022-04-14 18:22:34 +02:00
ret = regmap_set_bits ( micfil - > regmap , REG_MICFIL_CTRL1 ,
MICFIL_CTRL1_PDMIEN ) ;
2022-04-14 18:22:35 +02:00
if ( ret )
2019-01-04 09:17:38 +00:00
return ret ;
break ;
case SNDRV_PCM_TRIGGER_STOP :
case SNDRV_PCM_TRIGGER_SUSPEND :
case SNDRV_PCM_TRIGGER_PAUSE_PUSH :
/* Disable the module */
2022-04-14 18:22:34 +02:00
ret = regmap_clear_bits ( micfil - > regmap , REG_MICFIL_CTRL1 ,
MICFIL_CTRL1_PDMIEN ) ;
2022-04-14 18:22:35 +02:00
if ( ret )
2019-01-04 09:17:38 +00:00
return ret ;
ret = regmap_update_bits ( micfil - > regmap , REG_MICFIL_CTRL1 ,
2022-04-14 18:22:33 +02:00
MICFIL_CTRL1_DISEL ,
FIELD_PREP ( MICFIL_CTRL1_DISEL , MICFIL_CTRL1_DISEL_DISABLE ) ) ;
2022-04-14 18:22:35 +02:00
if ( ret )
2019-01-04 09:17:38 +00:00
return ret ;
break ;
default :
return - EINVAL ;
}
return 0 ;
}
static int fsl_set_clock_params ( struct device * dev , unsigned int rate )
{
struct fsl_micfil * micfil = dev_get_drvdata ( dev ) ;
2022-04-14 18:22:43 +02:00
int clk_div = 8 ;
2022-04-14 18:22:44 +02:00
int osr = MICFIL_OSR_DEFAULT ;
2020-05-18 19:00:40 +08:00
int ret ;
2019-01-04 09:17:38 +00:00
2022-04-14 18:22:44 +02:00
ret = clk_set_rate ( micfil - > mclk , rate * clk_div * osr * 8 ) ;
2022-04-14 18:22:43 +02:00
if ( ret )
return ret ;
2019-01-04 09:17:38 +00:00
2022-04-14 18:22:44 +02:00
ret = micfil_set_quality ( micfil ) ;
2019-01-04 09:17:38 +00:00
if ( ret )
2022-04-14 18:22:35 +02:00
return ret ;
2019-01-04 09:17:38 +00:00
2022-04-14 18:22:35 +02:00
ret = regmap_update_bits ( micfil - > regmap , REG_MICFIL_CTRL2 ,
2022-04-14 18:22:44 +02:00
MICFIL_CTRL2_CLKDIV | MICFIL_CTRL2_CICOSR ,
FIELD_PREP ( MICFIL_CTRL2_CLKDIV , clk_div ) |
FIELD_PREP ( MICFIL_CTRL2_CICOSR , 16 - osr ) ) ;
2019-01-04 09:17:38 +00:00
return ret ;
}
static int fsl_micfil_hw_params ( struct snd_pcm_substream * substream ,
struct snd_pcm_hw_params * params ,
struct snd_soc_dai * dai )
{
struct fsl_micfil * micfil = snd_soc_dai_get_drvdata ( dai ) ;
unsigned int channels = params_channels ( params ) ;
unsigned int rate = params_rate ( params ) ;
struct device * dev = & micfil - > pdev - > dev ;
int ret ;
/* 1. Disable the module */
2022-04-14 18:22:34 +02:00
ret = regmap_clear_bits ( micfil - > regmap , REG_MICFIL_CTRL1 ,
MICFIL_CTRL1_PDMIEN ) ;
2022-04-14 18:22:35 +02:00
if ( ret )
2019-01-04 09:17:38 +00:00
return ret ;
/* enable channels */
ret = regmap_update_bits ( micfil - > regmap , REG_MICFIL_CTRL1 ,
0xFF , ( ( 1 < < channels ) - 1 ) ) ;
2022-04-14 18:22:35 +02:00
if ( ret )
2019-01-04 09:17:38 +00:00
return ret ;
ret = fsl_set_clock_params ( dev , rate ) ;
if ( ret < 0 ) {
dev_err ( dev , " Failed to set clock parameters [%d] \n " , ret ) ;
return ret ;
}
2022-04-14 18:22:40 +02:00
micfil - > dma_params_rx . peripheral_config = & micfil - > sdmacfg ;
micfil - > dma_params_rx . peripheral_size = sizeof ( micfil - > sdmacfg ) ;
micfil - > sdmacfg . n_fifos_src = channels ;
micfil - > sdmacfg . sw_done = true ;
2019-01-04 09:17:38 +00:00
micfil - > dma_params_rx . maxburst = channels * MICFIL_DMA_MAXBURST_RX ;
return 0 ;
}
2021-02-06 23:58:49 +01:00
static const struct snd_soc_dai_ops fsl_micfil_dai_ops = {
2019-01-04 09:17:38 +00:00
. startup = fsl_micfil_startup ,
. trigger = fsl_micfil_trigger ,
. hw_params = fsl_micfil_hw_params ,
} ;
static int fsl_micfil_dai_probe ( struct snd_soc_dai * cpu_dai )
{
struct fsl_micfil * micfil = dev_get_drvdata ( cpu_dai - > dev ) ;
int ret ;
2022-04-14 18:22:44 +02:00
micfil - > quality = QUALITY_MEDIUM ;
2019-01-04 09:17:38 +00:00
/* set default gain to max_gain */
regmap_write ( micfil - > regmap , REG_MICFIL_OUT_CTRL , 0x77777777 ) ;
snd_soc_dai_init_dma_data ( cpu_dai , NULL ,
& micfil - > dma_params_rx ) ;
/* FIFO Watermark Control - FIFOWMK*/
ret = regmap_update_bits ( micfil - > regmap , REG_MICFIL_FIFO_CTRL ,
2022-04-14 18:22:33 +02:00
MICFIL_FIFO_CTRL_FIFOWMK ,
FIELD_PREP ( MICFIL_FIFO_CTRL_FIFOWMK , micfil - > soc - > fifo_depth - 1 ) ) ;
2022-04-14 18:22:35 +02:00
if ( ret )
2019-01-04 09:17:38 +00:00
return ret ;
return 0 ;
}
static struct snd_soc_dai_driver fsl_micfil_dai = {
. probe = fsl_micfil_dai_probe ,
. capture = {
. stream_name = " CPU-Capture " ,
. channels_min = 1 ,
. channels_max = 8 ,
. rates = FSL_MICFIL_RATES ,
. formats = FSL_MICFIL_FORMATS ,
} ,
. ops = & fsl_micfil_dai_ops ,
} ;
static const struct snd_soc_component_driver fsl_micfil_component = {
. name = " fsl-micfil-dai " ,
. controls = fsl_micfil_snd_controls ,
. num_controls = ARRAY_SIZE ( fsl_micfil_snd_controls ) ,
} ;
/* REGMAP */
static const struct reg_default fsl_micfil_reg_defaults [ ] = {
{ REG_MICFIL_CTRL1 , 0x00000000 } ,
{ REG_MICFIL_CTRL2 , 0x00000000 } ,
{ REG_MICFIL_STAT , 0x00000000 } ,
{ REG_MICFIL_FIFO_CTRL , 0x00000007 } ,
{ REG_MICFIL_FIFO_STAT , 0x00000000 } ,
{ REG_MICFIL_DATACH0 , 0x00000000 } ,
{ REG_MICFIL_DATACH1 , 0x00000000 } ,
{ REG_MICFIL_DATACH2 , 0x00000000 } ,
{ REG_MICFIL_DATACH3 , 0x00000000 } ,
{ REG_MICFIL_DATACH4 , 0x00000000 } ,
{ REG_MICFIL_DATACH5 , 0x00000000 } ,
{ REG_MICFIL_DATACH6 , 0x00000000 } ,
{ REG_MICFIL_DATACH7 , 0x00000000 } ,
{ REG_MICFIL_DC_CTRL , 0x00000000 } ,
{ REG_MICFIL_OUT_CTRL , 0x00000000 } ,
{ REG_MICFIL_OUT_STAT , 0x00000000 } ,
{ REG_MICFIL_VAD0_CTRL1 , 0x00000000 } ,
{ REG_MICFIL_VAD0_CTRL2 , 0x000A0000 } ,
{ REG_MICFIL_VAD0_STAT , 0x00000000 } ,
{ REG_MICFIL_VAD0_SCONFIG , 0x00000000 } ,
{ REG_MICFIL_VAD0_NCONFIG , 0x80000000 } ,
{ REG_MICFIL_VAD0_NDATA , 0x00000000 } ,
{ REG_MICFIL_VAD0_ZCD , 0x00000004 } ,
} ;
static bool fsl_micfil_readable_reg ( struct device * dev , unsigned int reg )
{
switch ( reg ) {
case REG_MICFIL_CTRL1 :
case REG_MICFIL_CTRL2 :
case REG_MICFIL_STAT :
case REG_MICFIL_FIFO_CTRL :
case REG_MICFIL_FIFO_STAT :
case REG_MICFIL_DATACH0 :
case REG_MICFIL_DATACH1 :
case REG_MICFIL_DATACH2 :
case REG_MICFIL_DATACH3 :
case REG_MICFIL_DATACH4 :
case REG_MICFIL_DATACH5 :
case REG_MICFIL_DATACH6 :
case REG_MICFIL_DATACH7 :
case REG_MICFIL_DC_CTRL :
case REG_MICFIL_OUT_CTRL :
case REG_MICFIL_OUT_STAT :
case REG_MICFIL_VAD0_CTRL1 :
case REG_MICFIL_VAD0_CTRL2 :
case REG_MICFIL_VAD0_STAT :
case REG_MICFIL_VAD0_SCONFIG :
case REG_MICFIL_VAD0_NCONFIG :
case REG_MICFIL_VAD0_NDATA :
case REG_MICFIL_VAD0_ZCD :
return true ;
default :
return false ;
}
}
static bool fsl_micfil_writeable_reg ( struct device * dev , unsigned int reg )
{
switch ( reg ) {
case REG_MICFIL_CTRL1 :
case REG_MICFIL_CTRL2 :
case REG_MICFIL_STAT : /* Write 1 to Clear */
case REG_MICFIL_FIFO_CTRL :
case REG_MICFIL_FIFO_STAT : /* Write 1 to Clear */
case REG_MICFIL_DC_CTRL :
case REG_MICFIL_OUT_CTRL :
case REG_MICFIL_OUT_STAT : /* Write 1 to Clear */
case REG_MICFIL_VAD0_CTRL1 :
case REG_MICFIL_VAD0_CTRL2 :
case REG_MICFIL_VAD0_STAT : /* Write 1 to Clear */
case REG_MICFIL_VAD0_SCONFIG :
case REG_MICFIL_VAD0_NCONFIG :
case REG_MICFIL_VAD0_ZCD :
return true ;
default :
return false ;
}
}
static bool fsl_micfil_volatile_reg ( struct device * dev , unsigned int reg )
{
switch ( reg ) {
case REG_MICFIL_STAT :
case REG_MICFIL_DATACH0 :
case REG_MICFIL_DATACH1 :
case REG_MICFIL_DATACH2 :
case REG_MICFIL_DATACH3 :
case REG_MICFIL_DATACH4 :
case REG_MICFIL_DATACH5 :
case REG_MICFIL_DATACH6 :
case REG_MICFIL_DATACH7 :
case REG_MICFIL_VAD0_STAT :
case REG_MICFIL_VAD0_NDATA :
return true ;
default :
return false ;
}
}
static const struct regmap_config fsl_micfil_regmap_config = {
. reg_bits = 32 ,
. reg_stride = 4 ,
. val_bits = 32 ,
. max_register = REG_MICFIL_VAD0_ZCD ,
. reg_defaults = fsl_micfil_reg_defaults ,
. num_reg_defaults = ARRAY_SIZE ( fsl_micfil_reg_defaults ) ,
. readable_reg = fsl_micfil_readable_reg ,
. volatile_reg = fsl_micfil_volatile_reg ,
. writeable_reg = fsl_micfil_writeable_reg ,
. cache_type = REGCACHE_RBTREE ,
} ;
/* END OF REGMAP */
static irqreturn_t micfil_isr ( int irq , void * devid )
{
struct fsl_micfil * micfil = ( struct fsl_micfil * ) devid ;
struct platform_device * pdev = micfil - > pdev ;
u32 stat_reg ;
u32 fifo_stat_reg ;
u32 ctrl1_reg ;
bool dma_enabled ;
int i ;
regmap_read ( micfil - > regmap , REG_MICFIL_STAT , & stat_reg ) ;
regmap_read ( micfil - > regmap , REG_MICFIL_CTRL1 , & ctrl1_reg ) ;
regmap_read ( micfil - > regmap , REG_MICFIL_FIFO_STAT , & fifo_stat_reg ) ;
2022-04-14 18:22:33 +02:00
dma_enabled = FIELD_GET ( MICFIL_CTRL1_DISEL , ctrl1_reg ) = = MICFIL_CTRL1_DISEL_DMA ;
2019-01-04 09:17:38 +00:00
/* Channel 0-7 Output Data Flags */
for ( i = 0 ; i < MICFIL_OUTPUT_CHANNELS ; i + + ) {
2022-04-14 18:22:33 +02:00
if ( stat_reg & MICFIL_STAT_CHXF ( i ) )
2019-01-04 09:17:38 +00:00
dev_dbg ( & pdev - > dev ,
" Data available in Data Channel %d \n " , i ) ;
/* if DMA is not enabled, field must be written with 1
* to clear
*/
if ( ! dma_enabled )
regmap_write_bits ( micfil - > regmap ,
REG_MICFIL_STAT ,
2022-04-14 18:22:33 +02:00
MICFIL_STAT_CHXF ( i ) ,
2019-01-04 09:17:38 +00:00
1 ) ;
}
for ( i = 0 ; i < MICFIL_FIFO_NUM ; i + + ) {
2022-04-14 18:22:33 +02:00
if ( fifo_stat_reg & MICFIL_FIFO_STAT_FIFOX_OVER ( i ) )
2019-01-04 09:17:38 +00:00
dev_dbg ( & pdev - > dev ,
" FIFO Overflow Exception flag for channel %d \n " ,
i ) ;
2022-04-14 18:22:33 +02:00
if ( fifo_stat_reg & MICFIL_FIFO_STAT_FIFOX_UNDER ( i ) )
2019-01-04 09:17:38 +00:00
dev_dbg ( & pdev - > dev ,
" FIFO Underflow Exception flag for channel %d \n " ,
i ) ;
}
return IRQ_HANDLED ;
}
static irqreturn_t micfil_err_isr ( int irq , void * devid )
{
struct fsl_micfil * micfil = ( struct fsl_micfil * ) devid ;
struct platform_device * pdev = micfil - > pdev ;
u32 stat_reg ;
regmap_read ( micfil - > regmap , REG_MICFIL_STAT , & stat_reg ) ;
2022-04-14 18:22:32 +02:00
if ( stat_reg & MICFIL_STAT_BSY_FIL )
2019-01-04 09:17:38 +00:00
dev_dbg ( & pdev - > dev , " isr: Decimation Filter is running \n " ) ;
2022-04-14 18:22:32 +02:00
if ( stat_reg & MICFIL_STAT_FIR_RDY )
2019-01-04 09:17:38 +00:00
dev_dbg ( & pdev - > dev , " isr: FIR Filter Data ready \n " ) ;
2022-04-14 18:22:32 +02:00
if ( stat_reg & MICFIL_STAT_LOWFREQF ) {
2019-01-04 09:17:38 +00:00
dev_dbg ( & pdev - > dev , " isr: ipg_clk_app is too low \n " ) ;
regmap_write_bits ( micfil - > regmap , REG_MICFIL_STAT ,
2022-04-14 18:22:32 +02:00
MICFIL_STAT_LOWFREQF , 1 ) ;
2019-01-04 09:17:38 +00:00
}
return IRQ_HANDLED ;
}
static int fsl_micfil_probe ( struct platform_device * pdev )
{
struct device_node * np = pdev - > dev . of_node ;
struct fsl_micfil * micfil ;
struct resource * res ;
void __iomem * regs ;
int ret , i ;
unsigned long irqflag = 0 ;
micfil = devm_kzalloc ( & pdev - > dev , sizeof ( * micfil ) , GFP_KERNEL ) ;
if ( ! micfil )
return - ENOMEM ;
micfil - > pdev = pdev ;
strncpy ( micfil - > name , np - > name , sizeof ( micfil - > name ) - 1 ) ;
2021-01-18 09:38:11 -03:00
micfil - > soc = of_device_get_match_data ( & pdev - > dev ) ;
2019-01-04 09:17:38 +00:00
/* ipg_clk is used to control the registers
* ipg_clk_app is used to operate the filter
*/
micfil - > mclk = devm_clk_get ( & pdev - > dev , " ipg_clk_app " ) ;
if ( IS_ERR ( micfil - > mclk ) ) {
dev_err ( & pdev - > dev , " failed to get core clock: %ld \n " ,
PTR_ERR ( micfil - > mclk ) ) ;
return PTR_ERR ( micfil - > mclk ) ;
}
2021-03-24 17:58:48 +08:00
micfil - > busclk = devm_clk_get ( & pdev - > dev , " ipg_clk " ) ;
if ( IS_ERR ( micfil - > busclk ) ) {
dev_err ( & pdev - > dev , " failed to get ipg clock: %ld \n " ,
PTR_ERR ( micfil - > busclk ) ) ;
return PTR_ERR ( micfil - > busclk ) ;
}
2019-01-04 09:17:38 +00:00
/* init regmap */
2021-06-15 09:39:18 +08:00
regs = devm_platform_get_and_ioremap_resource ( pdev , 0 , & res ) ;
2019-01-04 09:17:38 +00:00
if ( IS_ERR ( regs ) )
return PTR_ERR ( regs ) ;
2021-03-24 17:58:48 +08:00
micfil - > regmap = devm_regmap_init_mmio ( & pdev - > dev ,
regs ,
& fsl_micfil_regmap_config ) ;
2019-01-04 09:17:38 +00:00
if ( IS_ERR ( micfil - > regmap ) ) {
dev_err ( & pdev - > dev , " failed to init MICFIL regmap: %ld \n " ,
PTR_ERR ( micfil - > regmap ) ) ;
return PTR_ERR ( micfil - > regmap ) ;
}
/* dataline mask for RX */
ret = of_property_read_u32_index ( np ,
" fsl,dataline " ,
0 ,
& micfil - > dataline ) ;
if ( ret )
micfil - > dataline = 1 ;
if ( micfil - > dataline & ~ micfil - > soc - > dataline ) {
dev_err ( & pdev - > dev , " dataline setting error, Mask is 0x%X \n " ,
micfil - > soc - > dataline ) ;
return - EINVAL ;
}
/* get IRQs */
for ( i = 0 ; i < MICFIL_IRQ_LINES ; i + + ) {
micfil - > irq [ i ] = platform_get_irq ( pdev , i ) ;
dev_err ( & pdev - > dev , " GET IRQ: %d \n " , micfil - > irq [ i ] ) ;
2020-04-15 12:45:13 +08:00
if ( micfil - > irq [ i ] < 0 )
2019-01-04 09:17:38 +00:00
return micfil - > irq [ i ] ;
}
if ( of_property_read_bool ( np , " fsl,shared-interrupt " ) )
irqflag = IRQF_SHARED ;
2020-05-18 15:54:48 -03:00
/* Digital Microphone interface interrupt */
2019-01-04 09:17:38 +00:00
ret = devm_request_irq ( & pdev - > dev , micfil - > irq [ 0 ] ,
micfil_isr , irqflag ,
micfil - > name , micfil ) ;
if ( ret ) {
dev_err ( & pdev - > dev , " failed to claim mic interface irq %u \n " ,
micfil - > irq [ 0 ] ) ;
return ret ;
}
2020-05-18 15:54:48 -03:00
/* Digital Microphone interface error interrupt */
2019-01-04 09:17:38 +00:00
ret = devm_request_irq ( & pdev - > dev , micfil - > irq [ 1 ] ,
micfil_err_isr , irqflag ,
micfil - > name , micfil ) ;
if ( ret ) {
dev_err ( & pdev - > dev , " failed to claim mic interface error irq %u \n " ,
micfil - > irq [ 1 ] ) ;
return ret ;
}
micfil - > dma_params_rx . chan_name = " rx " ;
micfil - > dma_params_rx . addr = res - > start + REG_MICFIL_DATACH0 ;
micfil - > dma_params_rx . maxburst = MICFIL_DMA_MAXBURST_RX ;
platform_set_drvdata ( pdev , micfil ) ;
pm_runtime_enable ( & pdev - > dev ) ;
2021-03-24 17:58:48 +08:00
regcache_cache_only ( micfil - > regmap , true ) ;
2019-01-04 09:17:38 +00:00
2021-09-03 18:30:04 +08:00
/*
* Register platform component before registering cpu dai for there
* is not defer probe for platform component in snd_soc_add_pcm_runtime ( ) .
*/
ret = devm_snd_dmaengine_pcm_register ( & pdev - > dev , NULL , 0 ) ;
if ( ret ) {
dev_err ( & pdev - > dev , " failed to pcm register \n " ) ;
return ret ;
}
2019-01-04 09:17:38 +00:00
ret = devm_snd_soc_register_component ( & pdev - > dev , & fsl_micfil_component ,
& fsl_micfil_dai , 1 ) ;
if ( ret ) {
dev_err ( & pdev - > dev , " failed to register component %s \n " ,
fsl_micfil_component . name ) ;
}
return ret ;
}
static int __maybe_unused fsl_micfil_runtime_suspend ( struct device * dev )
{
struct fsl_micfil * micfil = dev_get_drvdata ( dev ) ;
regcache_cache_only ( micfil - > regmap , true ) ;
clk_disable_unprepare ( micfil - > mclk ) ;
2021-03-24 17:58:48 +08:00
clk_disable_unprepare ( micfil - > busclk ) ;
2019-01-04 09:17:38 +00:00
return 0 ;
}
static int __maybe_unused fsl_micfil_runtime_resume ( struct device * dev )
{
struct fsl_micfil * micfil = dev_get_drvdata ( dev ) ;
int ret ;
2021-03-24 17:58:48 +08:00
ret = clk_prepare_enable ( micfil - > busclk ) ;
2019-01-04 09:17:38 +00:00
if ( ret < 0 )
return ret ;
2021-03-24 17:58:48 +08:00
ret = clk_prepare_enable ( micfil - > mclk ) ;
if ( ret < 0 ) {
clk_disable_unprepare ( micfil - > busclk ) ;
return ret ;
}
2019-01-04 09:17:38 +00:00
regcache_cache_only ( micfil - > regmap , false ) ;
regcache_mark_dirty ( micfil - > regmap ) ;
regcache_sync ( micfil - > regmap ) ;
return 0 ;
}
static int __maybe_unused fsl_micfil_suspend ( struct device * dev )
{
pm_runtime_force_suspend ( dev ) ;
return 0 ;
}
static int __maybe_unused fsl_micfil_resume ( struct device * dev )
{
pm_runtime_force_resume ( dev ) ;
return 0 ;
}
static const struct dev_pm_ops fsl_micfil_pm_ops = {
SET_RUNTIME_PM_OPS ( fsl_micfil_runtime_suspend ,
fsl_micfil_runtime_resume ,
NULL )
SET_SYSTEM_SLEEP_PM_OPS ( fsl_micfil_suspend ,
fsl_micfil_resume )
} ;
static struct platform_driver fsl_micfil_driver = {
. probe = fsl_micfil_probe ,
. driver = {
. name = " fsl-micfil-dai " ,
. pm = & fsl_micfil_pm_ops ,
. of_match_table = fsl_micfil_dt_ids ,
} ,
} ;
module_platform_driver ( fsl_micfil_driver ) ;
MODULE_AUTHOR ( " Cosmin-Gabriel Samoila <cosmin.samoila@nxp.com> " ) ;
MODULE_DESCRIPTION ( " NXP PDM Microphone Interface (MICFIL) driver " ) ;
MODULE_LICENSE ( " GPL v2 " ) ;