1821 lines
46 KiB
C
1821 lines
46 KiB
C
|
// SPDX-License-Identifier: GPL-2.0-or-later
|
||
|
//
|
||
|
// sma1303.c -- sma1303 ALSA SoC Audio driver
|
||
|
//
|
||
|
// Copyright 2023 Iron Device Corporation
|
||
|
//
|
||
|
// Auther: Gyuhwa Park <gyuhwa.park@irondevice.com>
|
||
|
// Kiseok Jo <kiseok.jo@irondevice.com>
|
||
|
|
||
|
#include <linux/mod_devicetable.h>
|
||
|
#include <linux/module.h>
|
||
|
#include <linux/moduleparam.h>
|
||
|
#include <linux/kernel.h>
|
||
|
#include <linux/init.h>
|
||
|
#include <linux/delay.h>
|
||
|
#include <linux/pm.h>
|
||
|
#include <linux/i2c.h>
|
||
|
#include <linux/regmap.h>
|
||
|
#include <sound/core.h>
|
||
|
#include <sound/pcm.h>
|
||
|
#include <sound/pcm_params.h>
|
||
|
#include <sound/soc.h>
|
||
|
#include <sound/initval.h>
|
||
|
#include <sound/tlv.h>
|
||
|
#include <linux/slab.h>
|
||
|
#include <asm/div64.h>
|
||
|
|
||
|
#include "sma1303.h"
|
||
|
|
||
|
#define CHECK_PERIOD_TIME 1 /* sec per HZ */
|
||
|
#define MAX_CONTROL_NAME 48
|
||
|
|
||
|
#define PLL_MATCH(_input_clk_name, _output_clk_name, _input_clk,\
|
||
|
_post_n, _n, _vco, _p_cp)\
|
||
|
{\
|
||
|
.input_clk_name = _input_clk_name,\
|
||
|
.output_clk_name = _output_clk_name,\
|
||
|
.input_clk = _input_clk,\
|
||
|
.post_n = _post_n,\
|
||
|
.n = _n,\
|
||
|
.vco = _vco,\
|
||
|
.p_cp = _p_cp,\
|
||
|
}
|
||
|
|
||
|
enum sma1303_type {
|
||
|
SMA1303,
|
||
|
};
|
||
|
|
||
|
struct sma1303_pll_match {
|
||
|
char *input_clk_name;
|
||
|
char *output_clk_name;
|
||
|
unsigned int input_clk;
|
||
|
unsigned int post_n;
|
||
|
unsigned int n;
|
||
|
unsigned int vco;
|
||
|
unsigned int p_cp;
|
||
|
};
|
||
|
|
||
|
struct sma1303_priv {
|
||
|
enum sma1303_type devtype;
|
||
|
struct attribute_group *attr_grp;
|
||
|
struct delayed_work check_fault_work;
|
||
|
struct device *dev;
|
||
|
struct kobject *kobj;
|
||
|
struct regmap *regmap;
|
||
|
struct sma1303_pll_match *pll_matches;
|
||
|
bool amp_power_status;
|
||
|
bool force_mute_status;
|
||
|
int num_of_pll_matches;
|
||
|
int retry_cnt;
|
||
|
unsigned int amp_mode;
|
||
|
unsigned int cur_vol;
|
||
|
unsigned int format;
|
||
|
unsigned int frame_size;
|
||
|
unsigned int init_vol;
|
||
|
unsigned int last_bclk;
|
||
|
unsigned int last_ocp_val;
|
||
|
unsigned int last_over_temp;
|
||
|
unsigned int rev_num;
|
||
|
unsigned int sys_clk_id;
|
||
|
unsigned int tdm_slot_rx;
|
||
|
unsigned int tdm_slot_tx;
|
||
|
unsigned int tsdw_cnt;
|
||
|
long check_fault_period;
|
||
|
long check_fault_status;
|
||
|
};
|
||
|
|
||
|
static struct sma1303_pll_match sma1303_pll_matches[] = {
|
||
|
PLL_MATCH("1.411MHz", "24.595MHz", 1411200, 0x07, 0xF4, 0x8B, 0x03),
|
||
|
PLL_MATCH("1.536MHz", "24.576MHz", 1536000, 0x07, 0xE0, 0x8B, 0x03),
|
||
|
PLL_MATCH("3.072MHz", "24.576MHz", 3072000, 0x07, 0x70, 0x8B, 0x03),
|
||
|
PLL_MATCH("6.144MHz", "24.576MHz", 6144000, 0x07, 0x70, 0x8B, 0x07),
|
||
|
PLL_MATCH("12.288MHz", "24.576MHz", 12288000, 0x07, 0x70, 0x8B, 0x0B),
|
||
|
PLL_MATCH("19.2MHz", "24.343MHz", 19200000, 0x07, 0x47, 0x8B, 0x0A),
|
||
|
PLL_MATCH("24.576MHz", "24.576MHz", 24576000, 0x07, 0x70, 0x8B, 0x0F),
|
||
|
};
|
||
|
|
||
|
static int sma1303_startup(struct snd_soc_component *);
|
||
|
static int sma1303_shutdown(struct snd_soc_component *);
|
||
|
|
||
|
static const struct reg_default sma1303_reg_def[] = {
|
||
|
{ 0x00, 0x80 },
|
||
|
{ 0x01, 0x00 },
|
||
|
{ 0x02, 0x00 },
|
||
|
{ 0x03, 0x11 },
|
||
|
{ 0x04, 0x17 },
|
||
|
{ 0x09, 0x00 },
|
||
|
{ 0x0A, 0x31 },
|
||
|
{ 0x0B, 0x98 },
|
||
|
{ 0x0C, 0x84 },
|
||
|
{ 0x0D, 0x07 },
|
||
|
{ 0x0E, 0x3F },
|
||
|
{ 0x10, 0x00 },
|
||
|
{ 0x11, 0x00 },
|
||
|
{ 0x12, 0x00 },
|
||
|
{ 0x14, 0x5C },
|
||
|
{ 0x15, 0x01 },
|
||
|
{ 0x16, 0x0F },
|
||
|
{ 0x17, 0x0F },
|
||
|
{ 0x18, 0x0F },
|
||
|
{ 0x19, 0x00 },
|
||
|
{ 0x1A, 0x00 },
|
||
|
{ 0x1B, 0x00 },
|
||
|
{ 0x23, 0x19 },
|
||
|
{ 0x24, 0x00 },
|
||
|
{ 0x25, 0x00 },
|
||
|
{ 0x26, 0x04 },
|
||
|
{ 0x33, 0x00 },
|
||
|
{ 0x36, 0x92 },
|
||
|
{ 0x37, 0x27 },
|
||
|
{ 0x3B, 0x5A },
|
||
|
{ 0x3C, 0x20 },
|
||
|
{ 0x3D, 0x00 },
|
||
|
{ 0x3E, 0x03 },
|
||
|
{ 0x3F, 0x0C },
|
||
|
{ 0x8B, 0x07 },
|
||
|
{ 0x8C, 0x70 },
|
||
|
{ 0x8D, 0x8B },
|
||
|
{ 0x8E, 0x6F },
|
||
|
{ 0x8F, 0x03 },
|
||
|
{ 0x90, 0x26 },
|
||
|
{ 0x91, 0x42 },
|
||
|
{ 0x92, 0xE0 },
|
||
|
{ 0x94, 0x35 },
|
||
|
{ 0x95, 0x0C },
|
||
|
{ 0x96, 0x42 },
|
||
|
{ 0x97, 0x95 },
|
||
|
{ 0xA0, 0x00 },
|
||
|
{ 0xA1, 0x3B },
|
||
|
{ 0xA2, 0xC8 },
|
||
|
{ 0xA3, 0x28 },
|
||
|
{ 0xA4, 0x40 },
|
||
|
{ 0xA5, 0x01 },
|
||
|
{ 0xA6, 0x41 },
|
||
|
{ 0xA7, 0x00 },
|
||
|
};
|
||
|
|
||
|
static bool sma1303_readable_register(struct device *dev, unsigned int reg)
|
||
|
{
|
||
|
bool result;
|
||
|
|
||
|
if (reg > SMA1303_FF_DEVICE_INDEX)
|
||
|
return false;
|
||
|
|
||
|
switch (reg) {
|
||
|
case SMA1303_00_SYSTEM_CTRL ... SMA1303_04_INPUT1_CTRL4:
|
||
|
case SMA1303_09_OUTPUT_CTRL ... SMA1303_0E_MUTE_VOL_CTRL:
|
||
|
case SMA1303_10_SYSTEM_CTRL1 ... SMA1303_12_SYSTEM_CTRL3:
|
||
|
case SMA1303_14_MODULATOR ... SMA1303_1B_BASS_SPK7:
|
||
|
case SMA1303_23_COMP_LIM1 ... SMA1303_26_COMP_LIM4:
|
||
|
case SMA1303_33_SDM_CTRL ... SMA1303_34_OTP_DATA1:
|
||
|
case SMA1303_36_PROTECTION ... SMA1303_38_OTP_TRM0:
|
||
|
case SMA1303_3B_TEST1 ... SMA1303_3F_ATEST2:
|
||
|
case SMA1303_8B_PLL_POST_N ... SMA1303_92_FDPEC_CTRL:
|
||
|
case SMA1303_94_BOOST_CTRL1 ... SMA1303_97_BOOST_CTRL4:
|
||
|
case SMA1303_A0_PAD_CTRL0 ... SMA1303_A7_CLK_MON:
|
||
|
case SMA1303_FA_STATUS1 ... SMA1303_FB_STATUS2:
|
||
|
result = true;
|
||
|
break;
|
||
|
case SMA1303_FF_DEVICE_INDEX:
|
||
|
result = true;
|
||
|
break;
|
||
|
default:
|
||
|
result = false;
|
||
|
break;
|
||
|
}
|
||
|
return result;
|
||
|
}
|
||
|
|
||
|
static bool sma1303_writeable_register(struct device *dev, unsigned int reg)
|
||
|
{
|
||
|
bool result;
|
||
|
|
||
|
if (reg > SMA1303_FF_DEVICE_INDEX)
|
||
|
return false;
|
||
|
|
||
|
switch (reg) {
|
||
|
case SMA1303_00_SYSTEM_CTRL ... SMA1303_04_INPUT1_CTRL4:
|
||
|
case SMA1303_09_OUTPUT_CTRL ... SMA1303_0E_MUTE_VOL_CTRL:
|
||
|
case SMA1303_10_SYSTEM_CTRL1 ... SMA1303_12_SYSTEM_CTRL3:
|
||
|
case SMA1303_14_MODULATOR ... SMA1303_1B_BASS_SPK7:
|
||
|
case SMA1303_23_COMP_LIM1 ... SMA1303_26_COMP_LIM4:
|
||
|
case SMA1303_33_SDM_CTRL:
|
||
|
case SMA1303_36_PROTECTION ... SMA1303_37_SLOPE_CTRL:
|
||
|
case SMA1303_3B_TEST1 ... SMA1303_3F_ATEST2:
|
||
|
case SMA1303_8B_PLL_POST_N ... SMA1303_92_FDPEC_CTRL:
|
||
|
case SMA1303_94_BOOST_CTRL1 ... SMA1303_97_BOOST_CTRL4:
|
||
|
case SMA1303_A0_PAD_CTRL0 ... SMA1303_A7_CLK_MON:
|
||
|
result = true;
|
||
|
break;
|
||
|
default:
|
||
|
result = false;
|
||
|
break;
|
||
|
}
|
||
|
return result;
|
||
|
}
|
||
|
|
||
|
static bool sma1303_volatile_register(struct device *dev, unsigned int reg)
|
||
|
{
|
||
|
bool result;
|
||
|
|
||
|
switch (reg) {
|
||
|
case SMA1303_FA_STATUS1 ... SMA1303_FB_STATUS2:
|
||
|
result = true;
|
||
|
break;
|
||
|
case SMA1303_FF_DEVICE_INDEX:
|
||
|
result = true;
|
||
|
break;
|
||
|
default:
|
||
|
result = false;
|
||
|
break;
|
||
|
}
|
||
|
return result;
|
||
|
}
|
||
|
|
||
|
static const DECLARE_TLV_DB_SCALE(sma1303_spk_tlv, -6000, 50, 0);
|
||
|
|
||
|
static int sma1303_regmap_write(struct sma1303_priv *sma1303,
|
||
|
unsigned int reg, unsigned int val)
|
||
|
{
|
||
|
int ret = 0;
|
||
|
int cnt = sma1303->retry_cnt;
|
||
|
|
||
|
while (cnt--) {
|
||
|
ret = regmap_write(sma1303->regmap, reg, val);
|
||
|
if (ret < 0) {
|
||
|
dev_err(sma1303->dev,
|
||
|
"Failed to write [0x%02X]\n", reg);
|
||
|
} else
|
||
|
break;
|
||
|
}
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
static int sma1303_regmap_update_bits(struct sma1303_priv *sma1303,
|
||
|
unsigned int reg, unsigned int mask, unsigned int val, bool *change)
|
||
|
{
|
||
|
int ret = 0;
|
||
|
int cnt = sma1303->retry_cnt;
|
||
|
|
||
|
while (cnt--) {
|
||
|
ret = regmap_update_bits_check(sma1303->regmap, reg,
|
||
|
mask, val, change);
|
||
|
if (ret < 0) {
|
||
|
dev_err(sma1303->dev,
|
||
|
"Failed to update [0x%02X]\n", reg);
|
||
|
} else
|
||
|
break;
|
||
|
}
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
static int sma1303_regmap_read(struct sma1303_priv *sma1303,
|
||
|
unsigned int reg, unsigned int *val)
|
||
|
{
|
||
|
int ret = 0;
|
||
|
int cnt = sma1303->retry_cnt;
|
||
|
|
||
|
while (cnt--) {
|
||
|
ret = regmap_read(sma1303->regmap, reg, val);
|
||
|
if (ret < 0) {
|
||
|
dev_err(sma1303->dev,
|
||
|
"Failed to read [0x%02X]\n", reg);
|
||
|
} else
|
||
|
break;
|
||
|
}
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
static const char * const sma1303_aif_in_source_text[] = {
|
||
|
"Mono", "Left", "Right"};
|
||
|
static const char * const sma1303_aif_out_source_text[] = {
|
||
|
"Disable", "After_FmtC", "After_Mixer", "After_DSP", "After_Post",
|
||
|
"Clk_PLL", "Clk_OSC"};
|
||
|
static const char * const sma1303_tdm_slot_text[] = {
|
||
|
"Slot0", "Slot1", "Slot2", "Slot3",
|
||
|
"Slot4", "Slot5", "Slot6", "Slot7"};
|
||
|
|
||
|
static const struct soc_enum sma1303_aif_in_source_enum =
|
||
|
SOC_ENUM_SINGLE_EXT(ARRAY_SIZE(sma1303_aif_in_source_text),
|
||
|
sma1303_aif_in_source_text);
|
||
|
static const struct soc_enum sma1303_aif_out_source_enum =
|
||
|
SOC_ENUM_SINGLE_EXT(ARRAY_SIZE(sma1303_aif_out_source_text),
|
||
|
sma1303_aif_out_source_text);
|
||
|
static const struct soc_enum sma1303_tdm_slot_enum =
|
||
|
SOC_ENUM_SINGLE_EXT(ARRAY_SIZE(sma1303_tdm_slot_text),
|
||
|
sma1303_tdm_slot_text);
|
||
|
|
||
|
static int sma1303_force_mute_get(struct snd_kcontrol *kcontrol,
|
||
|
struct snd_ctl_elem_value *ucontrol)
|
||
|
{
|
||
|
struct snd_soc_component *component =
|
||
|
snd_soc_kcontrol_component(kcontrol);
|
||
|
struct sma1303_priv *sma1303 = snd_soc_component_get_drvdata(component);
|
||
|
|
||
|
ucontrol->value.integer.value[0] = (int)sma1303->force_mute_status;
|
||
|
dev_dbg(sma1303->dev, "%s : Force Mute %s\n", __func__,
|
||
|
sma1303->force_mute_status ? "ON" : "OFF");
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int sma1303_force_mute_put(struct snd_kcontrol *kcontrol,
|
||
|
struct snd_ctl_elem_value *ucontrol)
|
||
|
{
|
||
|
struct snd_soc_component *component =
|
||
|
snd_soc_kcontrol_component(kcontrol);
|
||
|
struct sma1303_priv *sma1303 = snd_soc_component_get_drvdata(component);
|
||
|
bool change = false, val = (bool)ucontrol->value.integer.value[0];
|
||
|
|
||
|
if (sma1303->force_mute_status == val)
|
||
|
change = false;
|
||
|
else {
|
||
|
change = true;
|
||
|
sma1303->force_mute_status = val;
|
||
|
}
|
||
|
dev_dbg(sma1303->dev, "%s : Force Mute %s\n", __func__,
|
||
|
sma1303->force_mute_status ? "ON" : "OFF");
|
||
|
|
||
|
return change;
|
||
|
}
|
||
|
|
||
|
static int sma1303_postscaler_get(struct snd_kcontrol *kcontrol,
|
||
|
struct snd_ctl_elem_value *ucontrol)
|
||
|
{
|
||
|
struct snd_soc_component *component =
|
||
|
snd_soc_kcontrol_component(kcontrol);
|
||
|
struct sma1303_priv *sma1303 = snd_soc_component_get_drvdata(component);
|
||
|
int val, ret;
|
||
|
|
||
|
ret = sma1303_regmap_read(sma1303, SMA1303_90_POSTSCALER, &val);
|
||
|
if (ret < 0)
|
||
|
return -EINVAL;
|
||
|
|
||
|
ucontrol->value.integer.value[0] = (val & 0x7E) >> 1;
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int sma1303_postscaler_put(struct snd_kcontrol *kcontrol,
|
||
|
struct snd_ctl_elem_value *ucontrol)
|
||
|
{
|
||
|
struct snd_soc_component *component =
|
||
|
snd_soc_kcontrol_component(kcontrol);
|
||
|
struct sma1303_priv *sma1303 = snd_soc_component_get_drvdata(component);
|
||
|
int ret, val = (int)ucontrol->value.integer.value[0];
|
||
|
bool change;
|
||
|
|
||
|
ret = sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_90_POSTSCALER, 0x7E, (val << 1), &change);
|
||
|
if (ret < 0)
|
||
|
return -EINVAL;
|
||
|
|
||
|
return change;
|
||
|
}
|
||
|
|
||
|
static int sma1303_tdm_slot_rx_get(struct snd_kcontrol *kcontrol,
|
||
|
struct snd_ctl_elem_value *ucontrol)
|
||
|
{
|
||
|
struct snd_soc_component *component =
|
||
|
snd_soc_kcontrol_component(kcontrol);
|
||
|
struct sma1303_priv *sma1303 = snd_soc_component_get_drvdata(component);
|
||
|
int val, ret;
|
||
|
|
||
|
ret = sma1303_regmap_read(sma1303, SMA1303_A5_TDM1, &val);
|
||
|
if (ret < 0)
|
||
|
return -EINVAL;
|
||
|
|
||
|
ucontrol->value.integer.value[0] = (val & 0x38) >> 3;
|
||
|
sma1303->tdm_slot_rx = ucontrol->value.integer.value[0];
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int sma1303_tdm_slot_rx_put(struct snd_kcontrol *kcontrol,
|
||
|
struct snd_ctl_elem_value *ucontrol)
|
||
|
{
|
||
|
struct snd_soc_component *component =
|
||
|
snd_soc_kcontrol_component(kcontrol);
|
||
|
struct sma1303_priv *sma1303 = snd_soc_component_get_drvdata(component);
|
||
|
int ret, val = (int)ucontrol->value.integer.value[0];
|
||
|
bool change;
|
||
|
|
||
|
ret = sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_A5_TDM1, 0x38, (val << 3), &change);
|
||
|
if (ret < 0)
|
||
|
return -EINVAL;
|
||
|
|
||
|
return change;
|
||
|
}
|
||
|
|
||
|
static int sma1303_tdm_slot_tx_get(struct snd_kcontrol *kcontrol,
|
||
|
struct snd_ctl_elem_value *ucontrol)
|
||
|
{
|
||
|
struct snd_soc_component *component =
|
||
|
snd_soc_kcontrol_component(kcontrol);
|
||
|
struct sma1303_priv *sma1303 = snd_soc_component_get_drvdata(component);
|
||
|
int val, ret;
|
||
|
|
||
|
ret = sma1303_regmap_read(sma1303, SMA1303_A6_TDM2, &val);
|
||
|
if (ret < 0)
|
||
|
return -EINVAL;
|
||
|
|
||
|
ucontrol->value.integer.value[0] = (val & 0x38) >> 3;
|
||
|
sma1303->tdm_slot_tx = ucontrol->value.integer.value[0];
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int sma1303_tdm_slot_tx_put(struct snd_kcontrol *kcontrol,
|
||
|
struct snd_ctl_elem_value *ucontrol)
|
||
|
{
|
||
|
struct snd_soc_component *component =
|
||
|
snd_soc_kcontrol_component(kcontrol);
|
||
|
struct sma1303_priv *sma1303 = snd_soc_component_get_drvdata(component);
|
||
|
int ret, val = (int)ucontrol->value.integer.value[0];
|
||
|
bool change;
|
||
|
|
||
|
ret = sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_A6_TDM2, 0x38, (val << 3), &change);
|
||
|
if (ret < 0)
|
||
|
return -EINVAL;
|
||
|
|
||
|
return change;
|
||
|
}
|
||
|
|
||
|
static int sma1303_startup(struct snd_soc_component *component)
|
||
|
{
|
||
|
struct sma1303_priv *sma1303 = snd_soc_component_get_drvdata(component);
|
||
|
bool change = false, temp = false;
|
||
|
|
||
|
sma1303_regmap_update_bits(sma1303, SMA1303_8E_PLL_CTRL,
|
||
|
SMA1303_PLL_PD2_MASK, SMA1303_PLL_OPERATION2, &temp);
|
||
|
if (temp == true)
|
||
|
change = true;
|
||
|
|
||
|
sma1303_regmap_update_bits(sma1303, SMA1303_00_SYSTEM_CTRL,
|
||
|
SMA1303_POWER_MASK, SMA1303_POWER_ON, &temp);
|
||
|
if (temp == true)
|
||
|
change = true;
|
||
|
|
||
|
if (sma1303->amp_mode == SMA1303_MONO) {
|
||
|
sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_10_SYSTEM_CTRL1,
|
||
|
SMA1303_SPK_MODE_MASK,
|
||
|
SMA1303_SPK_MONO,
|
||
|
&temp);
|
||
|
if (temp == true)
|
||
|
change = true;
|
||
|
|
||
|
} else {
|
||
|
sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_10_SYSTEM_CTRL1,
|
||
|
SMA1303_SPK_MODE_MASK,
|
||
|
SMA1303_SPK_STEREO,
|
||
|
&temp);
|
||
|
if (temp == true)
|
||
|
change = true;
|
||
|
}
|
||
|
|
||
|
if (sma1303->check_fault_status) {
|
||
|
if (sma1303->check_fault_period > 0)
|
||
|
queue_delayed_work(system_freezable_wq,
|
||
|
&sma1303->check_fault_work,
|
||
|
sma1303->check_fault_period * HZ);
|
||
|
else
|
||
|
queue_delayed_work(system_freezable_wq,
|
||
|
&sma1303->check_fault_work,
|
||
|
CHECK_PERIOD_TIME * HZ);
|
||
|
}
|
||
|
|
||
|
sma1303->amp_power_status = true;
|
||
|
|
||
|
return change;
|
||
|
}
|
||
|
|
||
|
static int sma1303_shutdown(struct snd_soc_component *component)
|
||
|
{
|
||
|
struct sma1303_priv *sma1303 = snd_soc_component_get_drvdata(component);
|
||
|
bool change = false, temp = false;
|
||
|
|
||
|
cancel_delayed_work_sync(&sma1303->check_fault_work);
|
||
|
|
||
|
sma1303_regmap_update_bits(sma1303, SMA1303_10_SYSTEM_CTRL1,
|
||
|
SMA1303_SPK_MODE_MASK, SMA1303_SPK_OFF, &temp);
|
||
|
if (temp == true)
|
||
|
change = true;
|
||
|
|
||
|
sma1303_regmap_update_bits(sma1303, SMA1303_00_SYSTEM_CTRL,
|
||
|
SMA1303_POWER_MASK, SMA1303_POWER_OFF, &temp);
|
||
|
if (temp == true)
|
||
|
change = true;
|
||
|
sma1303_regmap_update_bits(sma1303, SMA1303_8E_PLL_CTRL,
|
||
|
SMA1303_PLL_PD2_MASK, SMA1303_PLL_PD2, &temp);
|
||
|
if (temp == true)
|
||
|
change = true;
|
||
|
|
||
|
sma1303->amp_power_status = false;
|
||
|
|
||
|
return change;
|
||
|
}
|
||
|
|
||
|
static int sma1303_aif_in_event(struct snd_soc_dapm_widget *w,
|
||
|
struct snd_kcontrol *kcontrol, int event)
|
||
|
{
|
||
|
struct snd_soc_component *component =
|
||
|
snd_soc_dapm_to_component(w->dapm);
|
||
|
struct sma1303_priv *sma1303 = snd_soc_component_get_drvdata(component);
|
||
|
unsigned int mux = dapm_kcontrol_get_value(w->kcontrols[0]);
|
||
|
int ret = 0;
|
||
|
bool change = false, temp = false;
|
||
|
|
||
|
switch (event) {
|
||
|
case SND_SOC_DAPM_PRE_PMU:
|
||
|
switch (mux) {
|
||
|
case 0:
|
||
|
ret += sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_11_SYSTEM_CTRL2,
|
||
|
SMA1303_MONOMIX_MASK,
|
||
|
SMA1303_MONOMIX_ON,
|
||
|
&change);
|
||
|
sma1303->amp_mode = SMA1303_MONO;
|
||
|
break;
|
||
|
case 1:
|
||
|
ret += sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_11_SYSTEM_CTRL2,
|
||
|
SMA1303_MONOMIX_MASK,
|
||
|
SMA1303_MONOMIX_OFF,
|
||
|
&temp);
|
||
|
if (temp == true)
|
||
|
change = true;
|
||
|
ret += sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_11_SYSTEM_CTRL2,
|
||
|
SMA1303_LR_DATA_SW_MASK,
|
||
|
SMA1303_LR_DATA_SW_NORMAL,
|
||
|
&temp);
|
||
|
if (temp == true)
|
||
|
change = true;
|
||
|
sma1303->amp_mode = SMA1303_STEREO;
|
||
|
break;
|
||
|
case 2:
|
||
|
ret += sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_11_SYSTEM_CTRL2,
|
||
|
SMA1303_MONOMIX_MASK,
|
||
|
SMA1303_MONOMIX_OFF,
|
||
|
&temp);
|
||
|
if (temp == true)
|
||
|
change = true;
|
||
|
ret += sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_11_SYSTEM_CTRL2,
|
||
|
SMA1303_LR_DATA_SW_MASK,
|
||
|
SMA1303_LR_DATA_SW_SWAP,
|
||
|
&temp);
|
||
|
if (temp == true)
|
||
|
change = true;
|
||
|
sma1303->amp_mode = SMA1303_STEREO;
|
||
|
break;
|
||
|
default:
|
||
|
dev_err(sma1303->dev, "%s : Invalid value (%d)\n",
|
||
|
__func__, mux);
|
||
|
return -EINVAL;
|
||
|
}
|
||
|
|
||
|
dev_dbg(sma1303->dev, "%s : Source : %s\n", __func__,
|
||
|
sma1303_aif_in_source_text[mux]);
|
||
|
break;
|
||
|
}
|
||
|
if (ret < 0)
|
||
|
return -EINVAL;
|
||
|
return change;
|
||
|
}
|
||
|
|
||
|
static int sma1303_aif_out_event(struct snd_soc_dapm_widget *w,
|
||
|
struct snd_kcontrol *kcontrol, int event)
|
||
|
{
|
||
|
struct snd_soc_component *component =
|
||
|
snd_soc_dapm_to_component(w->dapm);
|
||
|
struct sma1303_priv *sma1303 = snd_soc_component_get_drvdata(component);
|
||
|
unsigned int mux = dapm_kcontrol_get_value(w->kcontrols[0]);
|
||
|
int ret = 0;
|
||
|
bool change = false, temp = false;
|
||
|
|
||
|
switch (event) {
|
||
|
case SND_SOC_DAPM_PRE_PMU:
|
||
|
switch (mux) {
|
||
|
case 0:
|
||
|
ret += sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_A3_TOP_MAN2,
|
||
|
SMA1303_TEST_CLKO_EN_MASK,
|
||
|
SMA1303_NORMAL_SDO,
|
||
|
&temp);
|
||
|
if (temp == true)
|
||
|
change = true;
|
||
|
ret += sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_09_OUTPUT_CTRL,
|
||
|
SMA1303_PORT_OUT_SEL_MASK,
|
||
|
SMA1303_OUT_SEL_DISABLE,
|
||
|
&temp);
|
||
|
if (temp == true)
|
||
|
change = true;
|
||
|
break;
|
||
|
case 1:
|
||
|
ret += sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_A3_TOP_MAN2,
|
||
|
SMA1303_TEST_CLKO_EN_MASK,
|
||
|
SMA1303_NORMAL_SDO,
|
||
|
&temp);
|
||
|
if (temp == true)
|
||
|
change = true;
|
||
|
ret += sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_09_OUTPUT_CTRL,
|
||
|
SMA1303_PORT_OUT_SEL_MASK,
|
||
|
SMA1303_FORMAT_CONVERTER,
|
||
|
&temp);
|
||
|
if (temp == true)
|
||
|
change = true;
|
||
|
break;
|
||
|
case 2:
|
||
|
ret += sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_A3_TOP_MAN2,
|
||
|
SMA1303_TEST_CLKO_EN_MASK,
|
||
|
SMA1303_NORMAL_SDO,
|
||
|
&temp);
|
||
|
if (temp == true)
|
||
|
change = true;
|
||
|
ret += sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_09_OUTPUT_CTRL,
|
||
|
SMA1303_PORT_OUT_SEL_MASK,
|
||
|
SMA1303_MIXER_OUTPUT,
|
||
|
&temp);
|
||
|
if (temp == true)
|
||
|
change = true;
|
||
|
break;
|
||
|
case 3:
|
||
|
ret += sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_A3_TOP_MAN2,
|
||
|
SMA1303_TEST_CLKO_EN_MASK,
|
||
|
SMA1303_NORMAL_SDO,
|
||
|
&temp);
|
||
|
if (temp == true)
|
||
|
change = true;
|
||
|
ret += sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_09_OUTPUT_CTRL,
|
||
|
SMA1303_PORT_OUT_SEL_MASK,
|
||
|
SMA1303_SPEAKER_PATH,
|
||
|
&temp);
|
||
|
if (temp == true)
|
||
|
change = true;
|
||
|
break;
|
||
|
case 4:
|
||
|
ret += sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_A3_TOP_MAN2,
|
||
|
SMA1303_TEST_CLKO_EN_MASK,
|
||
|
SMA1303_NORMAL_SDO,
|
||
|
&temp);
|
||
|
if (temp == true)
|
||
|
change = true;
|
||
|
ret += sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_09_OUTPUT_CTRL,
|
||
|
SMA1303_PORT_OUT_SEL_MASK,
|
||
|
SMA1303_POSTSCALER_OUTPUT,
|
||
|
&temp);
|
||
|
if (temp == true)
|
||
|
change = true;
|
||
|
break;
|
||
|
case 5:
|
||
|
ret += sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_A3_TOP_MAN2,
|
||
|
SMA1303_TEST_CLKO_EN_MASK,
|
||
|
SMA1303_CLK_OUT_SDO,
|
||
|
&temp);
|
||
|
if (temp == true)
|
||
|
change = true;
|
||
|
ret += sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_A3_TOP_MAN2,
|
||
|
SMA1303_MON_OSC_PLL_MASK,
|
||
|
SMA1303_PLL_SDO,
|
||
|
&temp);
|
||
|
if (temp == true)
|
||
|
change = true;
|
||
|
break;
|
||
|
case 6:
|
||
|
ret += sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_A3_TOP_MAN2,
|
||
|
SMA1303_TEST_CLKO_EN_MASK,
|
||
|
SMA1303_CLK_OUT_SDO,
|
||
|
&temp);
|
||
|
if (temp == true)
|
||
|
change = true;
|
||
|
ret += sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_A3_TOP_MAN2,
|
||
|
SMA1303_MON_OSC_PLL_MASK,
|
||
|
SMA1303_OSC_SDO,
|
||
|
&temp);
|
||
|
if (temp == true)
|
||
|
change = true;
|
||
|
break;
|
||
|
default:
|
||
|
dev_err(sma1303->dev, "%s : Invalid value (%d)\n",
|
||
|
__func__, mux);
|
||
|
return -EINVAL;
|
||
|
}
|
||
|
|
||
|
dev_dbg(sma1303->dev, "%s : Source : %s\n", __func__,
|
||
|
sma1303_aif_out_source_text[mux]);
|
||
|
break;
|
||
|
}
|
||
|
if (ret < 0)
|
||
|
return -EINVAL;
|
||
|
return change;
|
||
|
}
|
||
|
|
||
|
static int sma1303_sdo_event(struct snd_soc_dapm_widget *w,
|
||
|
struct snd_kcontrol *kcontrol, int event)
|
||
|
{
|
||
|
struct snd_soc_component *component =
|
||
|
snd_soc_dapm_to_component(w->dapm);
|
||
|
struct sma1303_priv *sma1303 = snd_soc_component_get_drvdata(component);
|
||
|
int ret = 0;
|
||
|
bool change = false, temp = false;
|
||
|
|
||
|
switch (event) {
|
||
|
case SND_SOC_DAPM_PRE_PMU:
|
||
|
dev_dbg(sma1303->dev,
|
||
|
"%s : SND_SOC_DAPM_PRE_PMU\n", __func__);
|
||
|
ret += sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_09_OUTPUT_CTRL,
|
||
|
SMA1303_PORT_CONFIG_MASK,
|
||
|
SMA1303_OUTPUT_PORT_ENABLE,
|
||
|
&temp);
|
||
|
if (temp == true)
|
||
|
change = true;
|
||
|
ret += sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_A3_TOP_MAN2,
|
||
|
SMA1303_SDO_OUTPUT_MASK,
|
||
|
SMA1303_NORMAL_OUT,
|
||
|
&temp);
|
||
|
if (temp == true)
|
||
|
change = true;
|
||
|
break;
|
||
|
case SND_SOC_DAPM_POST_PMD:
|
||
|
dev_dbg(sma1303->dev,
|
||
|
"%s : SND_SOC_DAPM_POST_PMD\n", __func__);
|
||
|
ret += sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_09_OUTPUT_CTRL,
|
||
|
SMA1303_PORT_CONFIG_MASK,
|
||
|
SMA1303_INPUT_PORT_ONLY,
|
||
|
&temp);
|
||
|
if (temp == true)
|
||
|
change = true;
|
||
|
ret += sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_A3_TOP_MAN2,
|
||
|
SMA1303_SDO_OUTPUT_MASK,
|
||
|
SMA1303_HIGH_Z_OUT,
|
||
|
&temp);
|
||
|
if (temp == true)
|
||
|
change = true;
|
||
|
break;
|
||
|
}
|
||
|
if (ret < 0)
|
||
|
return -EINVAL;
|
||
|
return change;
|
||
|
}
|
||
|
|
||
|
static int sma1303_post_scaler_event(struct snd_soc_dapm_widget *w,
|
||
|
struct snd_kcontrol *kcontrol, int event)
|
||
|
{
|
||
|
struct snd_soc_component *component =
|
||
|
snd_soc_dapm_to_component(w->dapm);
|
||
|
struct sma1303_priv *sma1303 = snd_soc_component_get_drvdata(component);
|
||
|
int ret = 0;
|
||
|
bool change = false;
|
||
|
|
||
|
switch (event) {
|
||
|
case SND_SOC_DAPM_PRE_PMU:
|
||
|
dev_dbg(sma1303->dev,
|
||
|
"%s : SND_SOC_DAPM_PRE_PMU\n", __func__);
|
||
|
ret += sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_90_POSTSCALER,
|
||
|
SMA1303_BYP_POST_MASK,
|
||
|
SMA1303_EN_POST_SCALER,
|
||
|
&change);
|
||
|
break;
|
||
|
case SND_SOC_DAPM_POST_PMD:
|
||
|
dev_dbg(sma1303->dev,
|
||
|
"%s : SND_SOC_DAPM_POST_PMD\n", __func__);
|
||
|
ret += sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_90_POSTSCALER,
|
||
|
SMA1303_BYP_POST_MASK,
|
||
|
SMA1303_BYP_POST_SCALER,
|
||
|
&change);
|
||
|
break;
|
||
|
}
|
||
|
if (ret < 0)
|
||
|
return -EINVAL;
|
||
|
return change;
|
||
|
}
|
||
|
|
||
|
static int sma1303_power_event(struct snd_soc_dapm_widget *w,
|
||
|
struct snd_kcontrol *kcontrol, int event)
|
||
|
{
|
||
|
struct snd_soc_component *component =
|
||
|
snd_soc_dapm_to_component(w->dapm);
|
||
|
struct sma1303_priv *sma1303 = snd_soc_component_get_drvdata(component);
|
||
|
int ret = 0;
|
||
|
|
||
|
switch (event) {
|
||
|
case SND_SOC_DAPM_POST_PMU:
|
||
|
dev_dbg(sma1303->dev,
|
||
|
"%s : SND_SOC_DAPM_POST_PMU\n", __func__);
|
||
|
ret = sma1303_startup(component);
|
||
|
break;
|
||
|
case SND_SOC_DAPM_PRE_PMD:
|
||
|
dev_dbg(sma1303->dev,
|
||
|
"%s : SND_SOC_DAPM_PRE_PMD\n", __func__);
|
||
|
ret = sma1303_shutdown(component);
|
||
|
break;
|
||
|
}
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
static const struct snd_kcontrol_new sma1303_aif_in_source_control =
|
||
|
SOC_DAPM_ENUM("AIF IN Source", sma1303_aif_in_source_enum);
|
||
|
static const struct snd_kcontrol_new sma1303_aif_out_source_control =
|
||
|
SOC_DAPM_ENUM("AIF OUT Source", sma1303_aif_out_source_enum);
|
||
|
static const struct snd_kcontrol_new sma1303_sdo_control =
|
||
|
SOC_DAPM_SINGLE_VIRT("Switch", 1);
|
||
|
static const struct snd_kcontrol_new sma1303_post_scaler_control =
|
||
|
SOC_DAPM_SINGLE_VIRT("Switch", 1);
|
||
|
static const struct snd_kcontrol_new sma1303_enable_control =
|
||
|
SOC_DAPM_SINGLE_VIRT("Switch", 1);
|
||
|
|
||
|
static const struct snd_kcontrol_new sma1303_snd_controls[] = {
|
||
|
SOC_SINGLE_TLV("Speaker Volume", SMA1303_0A_SPK_VOL,
|
||
|
0, 167, 1, sma1303_spk_tlv),
|
||
|
SOC_SINGLE_BOOL_EXT("Force Mute Switch", 0,
|
||
|
sma1303_force_mute_get, sma1303_force_mute_put),
|
||
|
SOC_SINGLE_EXT("Postscaler Gain", SMA1303_90_POSTSCALER, 1, 0x30, 0,
|
||
|
sma1303_postscaler_get, sma1303_postscaler_put),
|
||
|
SOC_ENUM_EXT("TDM RX Slot Position", sma1303_tdm_slot_enum,
|
||
|
sma1303_tdm_slot_rx_get, sma1303_tdm_slot_rx_put),
|
||
|
SOC_ENUM_EXT("TDM TX Slot Position", sma1303_tdm_slot_enum,
|
||
|
sma1303_tdm_slot_tx_get, sma1303_tdm_slot_tx_put),
|
||
|
};
|
||
|
|
||
|
static const struct snd_soc_dapm_widget sma1303_dapm_widgets[] = {
|
||
|
/* platform domain */
|
||
|
SND_SOC_DAPM_OUTPUT("SPK"),
|
||
|
SND_SOC_DAPM_INPUT("SDO"),
|
||
|
|
||
|
/* path domain */
|
||
|
SND_SOC_DAPM_MUX_E("AIF IN Source", SND_SOC_NOPM, 0, 0,
|
||
|
&sma1303_aif_in_source_control,
|
||
|
sma1303_aif_in_event,
|
||
|
SND_SOC_DAPM_PRE_PMU),
|
||
|
SND_SOC_DAPM_MUX_E("AIF OUT Source", SND_SOC_NOPM, 0, 0,
|
||
|
&sma1303_aif_out_source_control,
|
||
|
sma1303_aif_out_event,
|
||
|
SND_SOC_DAPM_PRE_PMU),
|
||
|
SND_SOC_DAPM_SWITCH_E("SDO Enable", SND_SOC_NOPM, 0, 0,
|
||
|
&sma1303_sdo_control,
|
||
|
sma1303_sdo_event,
|
||
|
SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD),
|
||
|
SND_SOC_DAPM_MIXER("Entry", SND_SOC_NOPM, 0, 0, NULL, 0),
|
||
|
SND_SOC_DAPM_SWITCH_E("Post Scaler", SND_SOC_NOPM, 0, 1,
|
||
|
&sma1303_post_scaler_control,
|
||
|
sma1303_post_scaler_event,
|
||
|
SND_SOC_DAPM_PRE_PMU | SND_SOC_DAPM_POST_PMD),
|
||
|
SND_SOC_DAPM_OUT_DRV_E("AMP Power", SND_SOC_NOPM, 0, 0, NULL, 0,
|
||
|
sma1303_power_event,
|
||
|
SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_PRE_PMD),
|
||
|
SND_SOC_DAPM_SWITCH("AMP Enable", SND_SOC_NOPM, 0, 1,
|
||
|
&sma1303_enable_control),
|
||
|
|
||
|
/* stream domain */
|
||
|
SND_SOC_DAPM_AIF_IN("AIF IN", "Playback", 0, SND_SOC_NOPM, 0, 0),
|
||
|
SND_SOC_DAPM_AIF_OUT("AIF OUT", "Capture", 0, SND_SOC_NOPM, 0, 0),
|
||
|
};
|
||
|
|
||
|
static const struct snd_soc_dapm_route sma1303_audio_map[] = {
|
||
|
/* Playback */
|
||
|
{"AIF IN Source", "Mono", "AIF IN"},
|
||
|
{"AIF IN Source", "Left", "AIF IN"},
|
||
|
{"AIF IN Source", "Right", "AIF IN"},
|
||
|
|
||
|
{"SDO Enable", "Switch", "AIF IN"},
|
||
|
{"AIF OUT Source", "Disable", "SDO Enable"},
|
||
|
{"AIF OUT Source", "After_FmtC", "SDO Enable"},
|
||
|
{"AIF OUT Source", "After_Mixer", "SDO Enable"},
|
||
|
{"AIF OUT Source", "After_DSP", "SDO Enable"},
|
||
|
{"AIF OUT Source", "After_Post", "SDO Enable"},
|
||
|
{"AIF OUT Source", "Clk_PLL", "SDO Enable"},
|
||
|
{"AIF OUT Source", "Clk_OSC", "SDO Enable"},
|
||
|
|
||
|
{"Entry", NULL, "AIF OUT Source"},
|
||
|
{"Entry", NULL, "AIF IN Source"},
|
||
|
|
||
|
{"Post Scaler", "Switch", "Entry"},
|
||
|
{"AMP Power", NULL, "Entry"},
|
||
|
{"AMP Power", NULL, "Entry"},
|
||
|
|
||
|
{"AMP Enable", "Switch", "AMP Power"},
|
||
|
{"SPK", NULL, "AMP Enable"},
|
||
|
|
||
|
/* Capture */
|
||
|
{"AIF OUT", NULL, "AMP Enable"},
|
||
|
};
|
||
|
|
||
|
static int sma1303_setup_pll(struct snd_soc_component *component,
|
||
|
unsigned int bclk)
|
||
|
{
|
||
|
struct sma1303_priv *sma1303 = snd_soc_component_get_drvdata(component);
|
||
|
|
||
|
int i = 0, ret = 0;
|
||
|
|
||
|
dev_dbg(component->dev, "%s : BCLK = %dHz\n",
|
||
|
__func__, bclk);
|
||
|
|
||
|
if (sma1303->sys_clk_id == SMA1303_PLL_CLKIN_MCLK) {
|
||
|
dev_dbg(component->dev, "%s : MCLK is not supported\n",
|
||
|
__func__);
|
||
|
} else if (sma1303->sys_clk_id == SMA1303_PLL_CLKIN_BCLK) {
|
||
|
for (i = 0; i < sma1303->num_of_pll_matches; i++) {
|
||
|
if (sma1303->pll_matches[i].input_clk == bclk)
|
||
|
break;
|
||
|
}
|
||
|
if (i == sma1303->num_of_pll_matches) {
|
||
|
dev_dbg(component->dev, "%s : No matching value between pll table and SCK\n",
|
||
|
__func__);
|
||
|
return -EINVAL;
|
||
|
}
|
||
|
|
||
|
ret += sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_A2_TOP_MAN1,
|
||
|
SMA1303_PLL_PD_MASK|SMA1303_PLL_REF_CLK_MASK,
|
||
|
SMA1303_PLL_OPERATION|SMA1303_PLL_SCK,
|
||
|
NULL);
|
||
|
}
|
||
|
|
||
|
ret += sma1303_regmap_write(sma1303,
|
||
|
SMA1303_8B_PLL_POST_N,
|
||
|
sma1303->pll_matches[i].post_n);
|
||
|
|
||
|
ret += sma1303_regmap_write(sma1303,
|
||
|
SMA1303_8C_PLL_N,
|
||
|
sma1303->pll_matches[i].n);
|
||
|
|
||
|
ret += sma1303_regmap_write(sma1303,
|
||
|
SMA1303_8D_PLL_A_SETTING,
|
||
|
sma1303->pll_matches[i].vco);
|
||
|
|
||
|
ret += sma1303_regmap_write(sma1303,
|
||
|
SMA1303_8F_PLL_P_CP,
|
||
|
sma1303->pll_matches[i].p_cp);
|
||
|
if (ret < 0)
|
||
|
return -EINVAL;
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int sma1303_dai_hw_params_amp(struct snd_pcm_substream *substream,
|
||
|
struct snd_pcm_hw_params *params, struct snd_soc_dai *dai)
|
||
|
{
|
||
|
struct snd_soc_component *component = dai->component;
|
||
|
struct sma1303_priv *sma1303 = snd_soc_component_get_drvdata(component);
|
||
|
unsigned int bclk = 0;
|
||
|
int ret = 0;
|
||
|
|
||
|
if (sma1303->format == SND_SOC_DAIFMT_DSP_A)
|
||
|
bclk = params_rate(params) * sma1303->frame_size;
|
||
|
else
|
||
|
bclk = params_rate(params) * params_physical_width(params)
|
||
|
* params_channels(params);
|
||
|
|
||
|
dev_dbg(component->dev,
|
||
|
"%s : rate = %d : bit size = %d : channel = %d\n",
|
||
|
__func__, params_rate(params), params_width(params),
|
||
|
params_channels(params));
|
||
|
|
||
|
if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
|
||
|
if (sma1303->sys_clk_id == SMA1303_PLL_CLKIN_BCLK) {
|
||
|
if (sma1303->last_bclk != bclk) {
|
||
|
sma1303_setup_pll(component, bclk);
|
||
|
sma1303->last_bclk = bclk;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
switch (params_rate(params)) {
|
||
|
case 8000:
|
||
|
case 12000:
|
||
|
case 16000:
|
||
|
case 24000:
|
||
|
case 32000:
|
||
|
case 44100:
|
||
|
case 48000:
|
||
|
case 96000:
|
||
|
ret += sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_A2_TOP_MAN1,
|
||
|
SMA1303_DAC_DN_CONV_MASK,
|
||
|
SMA1303_DAC_DN_CONV_DISABLE,
|
||
|
NULL);
|
||
|
|
||
|
ret += sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_01_INPUT1_CTRL1,
|
||
|
SMA1303_LEFTPOL_MASK,
|
||
|
SMA1303_LOW_FIRST_CH,
|
||
|
NULL);
|
||
|
break;
|
||
|
|
||
|
case 192000:
|
||
|
ret += sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_A2_TOP_MAN1,
|
||
|
SMA1303_DAC_DN_CONV_MASK,
|
||
|
SMA1303_DAC_DN_CONV_ENABLE,
|
||
|
NULL);
|
||
|
|
||
|
ret += sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_01_INPUT1_CTRL1,
|
||
|
SMA1303_LEFTPOL_MASK,
|
||
|
SMA1303_HIGH_FIRST_CH,
|
||
|
NULL);
|
||
|
break;
|
||
|
|
||
|
default:
|
||
|
dev_err(component->dev, "%s not support rate : %d\n",
|
||
|
__func__, params_rate(params));
|
||
|
|
||
|
return -EINVAL;
|
||
|
}
|
||
|
|
||
|
} else {
|
||
|
|
||
|
switch (params_format(params)) {
|
||
|
|
||
|
case SNDRV_PCM_FORMAT_S16_LE:
|
||
|
dev_dbg(component->dev,
|
||
|
"%s set format SNDRV_PCM_FORMAT_S16_LE\n",
|
||
|
__func__);
|
||
|
ret += sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_A4_TOP_MAN3,
|
||
|
SMA1303_SCK_RATE_MASK,
|
||
|
SMA1303_SCK_32FS,
|
||
|
NULL);
|
||
|
break;
|
||
|
|
||
|
case SNDRV_PCM_FORMAT_S24_LE:
|
||
|
dev_dbg(component->dev,
|
||
|
"%s set format SNDRV_PCM_FORMAT_S24_LE\n",
|
||
|
__func__);
|
||
|
ret += sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_A4_TOP_MAN3,
|
||
|
SMA1303_SCK_RATE_MASK,
|
||
|
SMA1303_SCK_64FS,
|
||
|
NULL);
|
||
|
break;
|
||
|
case SNDRV_PCM_FORMAT_S32_LE:
|
||
|
dev_dbg(component->dev,
|
||
|
"%s set format SNDRV_PCM_FORMAT_S32_LE\n",
|
||
|
__func__);
|
||
|
ret += sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_A4_TOP_MAN3,
|
||
|
SMA1303_SCK_RATE_MASK,
|
||
|
SMA1303_SCK_64FS,
|
||
|
NULL);
|
||
|
break;
|
||
|
default:
|
||
|
dev_err(component->dev,
|
||
|
"%s not support data bit : %d\n", __func__,
|
||
|
params_format(params));
|
||
|
return -EINVAL;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
switch (sma1303->format) {
|
||
|
case SND_SOC_DAIFMT_I2S:
|
||
|
ret += sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_01_INPUT1_CTRL1,
|
||
|
SMA1303_I2S_MODE_MASK,
|
||
|
SMA1303_STANDARD_I2S,
|
||
|
NULL);
|
||
|
ret += sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_A4_TOP_MAN3,
|
||
|
SMA1303_O_FORMAT_MASK,
|
||
|
SMA1303_O_FMT_I2S,
|
||
|
NULL);
|
||
|
break;
|
||
|
case SND_SOC_DAIFMT_LEFT_J:
|
||
|
ret += sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_01_INPUT1_CTRL1,
|
||
|
SMA1303_I2S_MODE_MASK,
|
||
|
SMA1303_LJ,
|
||
|
NULL);
|
||
|
ret += sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_A4_TOP_MAN3,
|
||
|
SMA1303_O_FORMAT_MASK,
|
||
|
SMA1303_O_FMT_LJ,
|
||
|
NULL);
|
||
|
break;
|
||
|
case SND_SOC_DAIFMT_RIGHT_J:
|
||
|
switch (params_width(params)) {
|
||
|
case 16:
|
||
|
ret += sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_01_INPUT1_CTRL1,
|
||
|
SMA1303_I2S_MODE_MASK,
|
||
|
SMA1303_RJ_16BIT,
|
||
|
NULL);
|
||
|
break;
|
||
|
case 24:
|
||
|
case 32:
|
||
|
ret += sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_01_INPUT1_CTRL1,
|
||
|
SMA1303_I2S_MODE_MASK,
|
||
|
SMA1303_RJ_24BIT,
|
||
|
NULL);
|
||
|
break;
|
||
|
}
|
||
|
break;
|
||
|
case SND_SOC_DAIFMT_DSP_A:
|
||
|
ret += sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_01_INPUT1_CTRL1,
|
||
|
SMA1303_I2S_MODE_MASK,
|
||
|
SMA1303_STANDARD_I2S,
|
||
|
NULL);
|
||
|
ret += sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_A4_TOP_MAN3,
|
||
|
SMA1303_O_FORMAT_MASK,
|
||
|
SMA1303_O_FMT_TDM,
|
||
|
NULL);
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
switch (params_width(params)) {
|
||
|
case 16:
|
||
|
case 24:
|
||
|
case 32:
|
||
|
break;
|
||
|
default:
|
||
|
dev_err(component->dev,
|
||
|
"%s not support data bit : %d\n", __func__,
|
||
|
params_format(params));
|
||
|
return -EINVAL;
|
||
|
}
|
||
|
if (ret < 0)
|
||
|
return -EINVAL;
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int sma1303_dai_set_sysclk_amp(struct snd_soc_dai *dai,
|
||
|
int clk_id, unsigned int freq, int dir)
|
||
|
{
|
||
|
struct snd_soc_component *component = dai->component;
|
||
|
struct sma1303_priv *sma1303 = snd_soc_component_get_drvdata(component);
|
||
|
|
||
|
switch (clk_id) {
|
||
|
case SMA1303_EXTERNAL_CLOCK_19_2:
|
||
|
break;
|
||
|
case SMA1303_EXTERNAL_CLOCK_24_576:
|
||
|
break;
|
||
|
case SMA1303_PLL_CLKIN_MCLK:
|
||
|
break;
|
||
|
case SMA1303_PLL_CLKIN_BCLK:
|
||
|
break;
|
||
|
default:
|
||
|
dev_err(component->dev, "Invalid clk id: %d\n", clk_id);
|
||
|
return -EINVAL;
|
||
|
}
|
||
|
sma1303->sys_clk_id = clk_id;
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int sma1303_dai_mute(struct snd_soc_dai *dai, int mute, int stream)
|
||
|
{
|
||
|
struct snd_soc_component *component = dai->component;
|
||
|
struct sma1303_priv *sma1303 = snd_soc_component_get_drvdata(component);
|
||
|
int ret = 0;
|
||
|
|
||
|
if (stream == SNDRV_PCM_STREAM_CAPTURE)
|
||
|
return ret;
|
||
|
|
||
|
if (mute) {
|
||
|
dev_dbg(component->dev, "%s : %s\n", __func__, "MUTE");
|
||
|
|
||
|
ret += sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_0E_MUTE_VOL_CTRL,
|
||
|
SMA1303_SPK_MUTE_MASK,
|
||
|
SMA1303_SPK_MUTE,
|
||
|
NULL);
|
||
|
|
||
|
/* Need to wait time for mute slope */
|
||
|
msleep(55);
|
||
|
} else {
|
||
|
if (!sma1303->force_mute_status) {
|
||
|
dev_dbg(component->dev, "%s : %s\n",
|
||
|
__func__, "UNMUTE");
|
||
|
ret += sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_0E_MUTE_VOL_CTRL,
|
||
|
SMA1303_SPK_MUTE_MASK,
|
||
|
SMA1303_SPK_UNMUTE,
|
||
|
NULL);
|
||
|
} else {
|
||
|
dev_dbg(sma1303->dev,
|
||
|
"%s : FORCE MUTE!!!\n", __func__);
|
||
|
}
|
||
|
}
|
||
|
|
||
|
if (ret < 0)
|
||
|
return -EINVAL;
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int sma1303_dai_set_fmt_amp(struct snd_soc_dai *dai,
|
||
|
unsigned int fmt)
|
||
|
{
|
||
|
struct snd_soc_component *component = dai->component;
|
||
|
struct sma1303_priv *sma1303 = snd_soc_component_get_drvdata(component);
|
||
|
int ret = 0;
|
||
|
|
||
|
switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
|
||
|
|
||
|
case SND_SOC_DAIFMT_CBC_CFC:
|
||
|
dev_dbg(component->dev,
|
||
|
"%s : %s\n", __func__, "I2S/TDM Device mode");
|
||
|
ret += sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_01_INPUT1_CTRL1,
|
||
|
SMA1303_CONTROLLER_DEVICE_MASK,
|
||
|
SMA1303_DEVICE_MODE,
|
||
|
NULL);
|
||
|
break;
|
||
|
|
||
|
case SND_SOC_DAIFMT_CBP_CFP:
|
||
|
dev_dbg(component->dev,
|
||
|
"%s : %s\n", __func__, "I2S/TDM Controller mode");
|
||
|
ret += sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_01_INPUT1_CTRL1,
|
||
|
SMA1303_CONTROLLER_DEVICE_MASK,
|
||
|
SMA1303_CONTROLLER_MODE,
|
||
|
NULL);
|
||
|
break;
|
||
|
|
||
|
default:
|
||
|
dev_err(component->dev,
|
||
|
"Unsupported Controller/Device : 0x%x\n", fmt);
|
||
|
return -EINVAL;
|
||
|
}
|
||
|
|
||
|
switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
|
||
|
|
||
|
case SND_SOC_DAIFMT_I2S:
|
||
|
case SND_SOC_DAIFMT_RIGHT_J:
|
||
|
case SND_SOC_DAIFMT_LEFT_J:
|
||
|
case SND_SOC_DAIFMT_DSP_A:
|
||
|
case SND_SOC_DAIFMT_DSP_B:
|
||
|
sma1303->format = fmt & SND_SOC_DAIFMT_FORMAT_MASK;
|
||
|
break;
|
||
|
default:
|
||
|
dev_err(component->dev,
|
||
|
"Unsupported Audio Interface Format : 0x%x\n", fmt);
|
||
|
return -EINVAL;
|
||
|
}
|
||
|
|
||
|
switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
|
||
|
|
||
|
case SND_SOC_DAIFMT_IB_NF:
|
||
|
dev_dbg(component->dev, "%s : %s\n",
|
||
|
__func__, "Invert BCLK + Normal Frame");
|
||
|
ret += sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_01_INPUT1_CTRL1,
|
||
|
SMA1303_SCK_RISING_MASK,
|
||
|
SMA1303_SCK_RISING_EDGE,
|
||
|
NULL);
|
||
|
break;
|
||
|
case SND_SOC_DAIFMT_IB_IF:
|
||
|
dev_dbg(component->dev, "%s : %s\n",
|
||
|
__func__, "Invert BCLK + Invert Frame");
|
||
|
ret += sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_01_INPUT1_CTRL1,
|
||
|
SMA1303_LEFTPOL_MASK|SMA1303_SCK_RISING_MASK,
|
||
|
SMA1303_HIGH_FIRST_CH|SMA1303_SCK_RISING_EDGE,
|
||
|
NULL);
|
||
|
break;
|
||
|
case SND_SOC_DAIFMT_NB_IF:
|
||
|
dev_dbg(component->dev, "%s : %s\n",
|
||
|
__func__, "Normal BCLK + Invert Frame");
|
||
|
ret += sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_01_INPUT1_CTRL1,
|
||
|
SMA1303_LEFTPOL_MASK,
|
||
|
SMA1303_HIGH_FIRST_CH,
|
||
|
NULL);
|
||
|
break;
|
||
|
case SND_SOC_DAIFMT_NB_NF:
|
||
|
dev_dbg(component->dev, "%s : %s\n",
|
||
|
__func__, "Normal BCLK + Normal Frame");
|
||
|
break;
|
||
|
default:
|
||
|
dev_err(component->dev,
|
||
|
"Unsupported Bit & Frameclock : 0x%x\n", fmt);
|
||
|
return -EINVAL;
|
||
|
}
|
||
|
|
||
|
if (ret < 0)
|
||
|
return -EINVAL;
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static int sma1303_dai_set_tdm_slot(struct snd_soc_dai *dai,
|
||
|
unsigned int tx_mask, unsigned int rx_mask,
|
||
|
int slots, int slot_width)
|
||
|
{
|
||
|
struct snd_soc_component *component = dai->component;
|
||
|
struct sma1303_priv *sma1303 = snd_soc_component_get_drvdata(component);
|
||
|
int ret = 0;
|
||
|
|
||
|
dev_dbg(component->dev, "%s : slots = %d, slot_width - %d\n",
|
||
|
__func__, slots, slot_width);
|
||
|
|
||
|
sma1303->frame_size = slot_width * slots;
|
||
|
|
||
|
ret += sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_A4_TOP_MAN3,
|
||
|
SMA1303_O_FORMAT_MASK,
|
||
|
SMA1303_O_FMT_TDM,
|
||
|
NULL);
|
||
|
|
||
|
switch (slot_width) {
|
||
|
case 16:
|
||
|
ret += sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_A6_TDM2,
|
||
|
SMA1303_TDM_DL_MASK,
|
||
|
SMA1303_TDM_DL_16,
|
||
|
NULL);
|
||
|
break;
|
||
|
case 32:
|
||
|
ret += sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_A6_TDM2,
|
||
|
SMA1303_TDM_DL_MASK,
|
||
|
SMA1303_TDM_DL_32,
|
||
|
NULL);
|
||
|
break;
|
||
|
default:
|
||
|
dev_err(component->dev, "%s not support TDM %d slot_width\n",
|
||
|
__func__, slot_width);
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
switch (slots) {
|
||
|
case 4:
|
||
|
ret += sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_A6_TDM2,
|
||
|
SMA1303_TDM_N_SLOT_MASK,
|
||
|
SMA1303_TDM_N_SLOT_4,
|
||
|
NULL);
|
||
|
break;
|
||
|
case 8:
|
||
|
ret += sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_A6_TDM2,
|
||
|
SMA1303_TDM_N_SLOT_MASK,
|
||
|
SMA1303_TDM_N_SLOT_8,
|
||
|
NULL);
|
||
|
break;
|
||
|
default:
|
||
|
dev_err(component->dev, "%s not support TDM %d slots\n",
|
||
|
__func__, slots);
|
||
|
break;
|
||
|
}
|
||
|
|
||
|
if (sma1303->tdm_slot_rx < slots)
|
||
|
ret += sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_A5_TDM1,
|
||
|
SMA1303_TDM_SLOT1_RX_POS_MASK,
|
||
|
(sma1303->tdm_slot_rx) << 3,
|
||
|
NULL);
|
||
|
else
|
||
|
dev_err(component->dev, "%s Incorrect tdm-slot-rx %d set\n",
|
||
|
__func__, sma1303->tdm_slot_rx);
|
||
|
|
||
|
ret += sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_A5_TDM1,
|
||
|
SMA1303_TDM_CLK_POL_MASK,
|
||
|
SMA1303_TDM_CLK_POL_RISE,
|
||
|
NULL);
|
||
|
|
||
|
ret += sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_A5_TDM1,
|
||
|
SMA1303_TDM_TX_MODE_MASK,
|
||
|
SMA1303_TDM_TX_MONO,
|
||
|
NULL);
|
||
|
|
||
|
if (sma1303->tdm_slot_tx < slots)
|
||
|
ret += sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_A6_TDM2,
|
||
|
SMA1303_TDM_SLOT1_TX_POS_MASK,
|
||
|
(sma1303->tdm_slot_tx) << 3,
|
||
|
NULL);
|
||
|
else
|
||
|
dev_err(component->dev, "%s Incorrect tdm-slot-tx %d set\n",
|
||
|
__func__, sma1303->tdm_slot_tx);
|
||
|
|
||
|
if (ret < 0)
|
||
|
return -EINVAL;
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static const struct snd_soc_dai_ops sma1303_dai_ops_amp = {
|
||
|
.set_sysclk = sma1303_dai_set_sysclk_amp,
|
||
|
.set_fmt = sma1303_dai_set_fmt_amp,
|
||
|
.hw_params = sma1303_dai_hw_params_amp,
|
||
|
.mute_stream = sma1303_dai_mute,
|
||
|
.set_tdm_slot = sma1303_dai_set_tdm_slot,
|
||
|
};
|
||
|
|
||
|
#define SMA1303_RATES SNDRV_PCM_RATE_8000_192000
|
||
|
#define SMA1303_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S24_LE | \
|
||
|
SNDRV_PCM_FMTBIT_S32_LE)
|
||
|
|
||
|
static struct snd_soc_dai_driver sma1303_dai[] = {
|
||
|
{
|
||
|
.name = "sma1303-amplifier",
|
||
|
.id = 0,
|
||
|
.playback = {
|
||
|
.stream_name = "Playback",
|
||
|
.channels_min = 1,
|
||
|
.channels_max = 2,
|
||
|
.rates = SMA1303_RATES,
|
||
|
.formats = SMA1303_FORMATS,
|
||
|
},
|
||
|
.capture = {
|
||
|
.stream_name = "Capture",
|
||
|
.channels_min = 1,
|
||
|
.channels_max = 2,
|
||
|
.rates = SMA1303_RATES,
|
||
|
.formats = SMA1303_FORMATS,
|
||
|
},
|
||
|
.ops = &sma1303_dai_ops_amp,
|
||
|
},
|
||
|
};
|
||
|
|
||
|
static void sma1303_check_fault_worker(struct work_struct *work)
|
||
|
{
|
||
|
struct sma1303_priv *sma1303 =
|
||
|
container_of(work, struct sma1303_priv, check_fault_work.work);
|
||
|
int ret = 0;
|
||
|
unsigned int over_temp, ocp_val, uvlo_val;
|
||
|
|
||
|
if (sma1303->tsdw_cnt)
|
||
|
ret = sma1303_regmap_read(sma1303,
|
||
|
SMA1303_0A_SPK_VOL, &sma1303->cur_vol);
|
||
|
else
|
||
|
ret = sma1303_regmap_read(sma1303,
|
||
|
SMA1303_0A_SPK_VOL, &sma1303->init_vol);
|
||
|
|
||
|
if (ret != 0) {
|
||
|
dev_err(sma1303->dev,
|
||
|
"failed to read SMA1303_0A_SPK_VOL : %d\n", ret);
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
ret = sma1303_regmap_read(sma1303, SMA1303_FA_STATUS1, &over_temp);
|
||
|
if (ret != 0) {
|
||
|
dev_err(sma1303->dev,
|
||
|
"failed to read SMA1303_FA_STATUS1 : %d\n", ret);
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
ret = sma1303_regmap_read(sma1303, SMA1303_FB_STATUS2, &ocp_val);
|
||
|
if (ret != 0) {
|
||
|
dev_err(sma1303->dev,
|
||
|
"failed to read SMA1303_FB_STATUS2 : %d\n", ret);
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
ret = sma1303_regmap_read(sma1303, SMA1303_FF_DEVICE_INDEX, &uvlo_val);
|
||
|
if (ret != 0) {
|
||
|
dev_err(sma1303->dev,
|
||
|
"failed to read SMA1303_FF_DEVICE_INDEX : %d\n", ret);
|
||
|
return;
|
||
|
}
|
||
|
|
||
|
if (~over_temp & SMA1303_OT1_OK_STATUS) {
|
||
|
dev_crit(sma1303->dev,
|
||
|
"%s : OT1(Over Temperature Level 1)\n", __func__);
|
||
|
|
||
|
if ((sma1303->cur_vol + 6) <= 0xFF)
|
||
|
sma1303_regmap_write(sma1303,
|
||
|
SMA1303_0A_SPK_VOL, sma1303->cur_vol + 6);
|
||
|
|
||
|
sma1303->tsdw_cnt++;
|
||
|
} else if (sma1303->tsdw_cnt) {
|
||
|
sma1303_regmap_write(sma1303,
|
||
|
SMA1303_0A_SPK_VOL, sma1303->init_vol);
|
||
|
sma1303->tsdw_cnt = 0;
|
||
|
sma1303->cur_vol = sma1303->init_vol;
|
||
|
}
|
||
|
|
||
|
if (~over_temp & SMA1303_OT2_OK_STATUS) {
|
||
|
dev_crit(sma1303->dev,
|
||
|
"%s : OT2(Over Temperature Level 2)\n", __func__);
|
||
|
}
|
||
|
if (ocp_val & SMA1303_OCP_SPK_STATUS) {
|
||
|
dev_crit(sma1303->dev,
|
||
|
"%s : OCP_SPK(Over Current Protect SPK)\n", __func__);
|
||
|
}
|
||
|
if (ocp_val & SMA1303_OCP_BST_STATUS) {
|
||
|
dev_crit(sma1303->dev,
|
||
|
"%s : OCP_BST(Over Current Protect Boost)\n", __func__);
|
||
|
}
|
||
|
if ((ocp_val & SMA1303_CLK_MON_STATUS) && (sma1303->amp_power_status)) {
|
||
|
dev_crit(sma1303->dev,
|
||
|
"%s : CLK_FAULT(No clock input)\n", __func__);
|
||
|
}
|
||
|
if (uvlo_val & SMA1303_UVLO_BST_STATUS) {
|
||
|
dev_crit(sma1303->dev,
|
||
|
"%s : UVLO(Under Voltage Lock Out)\n", __func__);
|
||
|
}
|
||
|
|
||
|
if ((over_temp != sma1303->last_over_temp) ||
|
||
|
(ocp_val != sma1303->last_ocp_val)) {
|
||
|
|
||
|
dev_crit(sma1303->dev, "Please check AMP status");
|
||
|
dev_dbg(sma1303->dev, "STATUS1=0x%02X : STATUS2=0x%02X\n",
|
||
|
over_temp, ocp_val);
|
||
|
sma1303->last_over_temp = over_temp;
|
||
|
sma1303->last_ocp_val = ocp_val;
|
||
|
}
|
||
|
|
||
|
if (sma1303->check_fault_status) {
|
||
|
if (sma1303->check_fault_period > 0)
|
||
|
queue_delayed_work(system_freezable_wq,
|
||
|
&sma1303->check_fault_work,
|
||
|
sma1303->check_fault_period * HZ);
|
||
|
else
|
||
|
queue_delayed_work(system_freezable_wq,
|
||
|
&sma1303->check_fault_work,
|
||
|
CHECK_PERIOD_TIME * HZ);
|
||
|
}
|
||
|
|
||
|
if (!(~over_temp & SMA1303_OT1_OK_STATUS)
|
||
|
&& !(~over_temp & SMA1303_OT2_OK_STATUS)
|
||
|
&& !(ocp_val & SMA1303_OCP_SPK_STATUS)
|
||
|
&& !(ocp_val & SMA1303_OCP_BST_STATUS)
|
||
|
&& !(ocp_val & SMA1303_CLK_MON_STATUS)
|
||
|
&& !(uvlo_val & SMA1303_UVLO_BST_STATUS)) {
|
||
|
}
|
||
|
}
|
||
|
|
||
|
static int sma1303_probe(struct snd_soc_component *component)
|
||
|
{
|
||
|
struct snd_soc_dapm_context *dapm =
|
||
|
snd_soc_component_get_dapm(component);
|
||
|
|
||
|
snd_soc_dapm_sync(dapm);
|
||
|
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
static void sma1303_remove(struct snd_soc_component *component)
|
||
|
{
|
||
|
struct sma1303_priv *sma1303 = snd_soc_component_get_drvdata(component);
|
||
|
|
||
|
cancel_delayed_work_sync(&sma1303->check_fault_work);
|
||
|
}
|
||
|
|
||
|
static const struct snd_soc_component_driver sma1303_component = {
|
||
|
.probe = sma1303_probe,
|
||
|
.remove = sma1303_remove,
|
||
|
.controls = sma1303_snd_controls,
|
||
|
.num_controls = ARRAY_SIZE(sma1303_snd_controls),
|
||
|
.dapm_widgets = sma1303_dapm_widgets,
|
||
|
.num_dapm_widgets = ARRAY_SIZE(sma1303_dapm_widgets),
|
||
|
.dapm_routes = sma1303_audio_map,
|
||
|
.num_dapm_routes = ARRAY_SIZE(sma1303_audio_map),
|
||
|
};
|
||
|
|
||
|
static const struct regmap_config sma_i2c_regmap = {
|
||
|
.reg_bits = 8,
|
||
|
.val_bits = 8,
|
||
|
|
||
|
.max_register = SMA1303_FF_DEVICE_INDEX,
|
||
|
.readable_reg = sma1303_readable_register,
|
||
|
.writeable_reg = sma1303_writeable_register,
|
||
|
.volatile_reg = sma1303_volatile_register,
|
||
|
|
||
|
.cache_type = REGCACHE_NONE,
|
||
|
.reg_defaults = sma1303_reg_def,
|
||
|
.num_reg_defaults = ARRAY_SIZE(sma1303_reg_def),
|
||
|
};
|
||
|
|
||
|
static ssize_t check_fault_period_show(struct device *dev,
|
||
|
struct device_attribute *devattr, char *buf)
|
||
|
{
|
||
|
struct sma1303_priv *sma1303 = dev_get_drvdata(dev);
|
||
|
|
||
|
return sysfs_emit(buf, "%ld\n", sma1303->check_fault_period);
|
||
|
}
|
||
|
|
||
|
static ssize_t check_fault_period_store(struct device *dev,
|
||
|
struct device_attribute *devattr, const char *buf, size_t count)
|
||
|
{
|
||
|
struct sma1303_priv *sma1303 = dev_get_drvdata(dev);
|
||
|
int ret;
|
||
|
|
||
|
ret = kstrtol(buf, 10, &sma1303->check_fault_period);
|
||
|
|
||
|
if (ret)
|
||
|
return -EINVAL;
|
||
|
|
||
|
return (ssize_t)count;
|
||
|
}
|
||
|
|
||
|
static DEVICE_ATTR_RW(check_fault_period);
|
||
|
|
||
|
static ssize_t check_fault_status_show(struct device *dev,
|
||
|
struct device_attribute *devattr, char *buf)
|
||
|
{
|
||
|
struct sma1303_priv *sma1303 = dev_get_drvdata(dev);
|
||
|
|
||
|
return sysfs_emit(buf, "%ld\n", sma1303->check_fault_status);
|
||
|
}
|
||
|
|
||
|
static ssize_t check_fault_status_store(struct device *dev,
|
||
|
struct device_attribute *devattr, const char *buf, size_t count)
|
||
|
{
|
||
|
struct sma1303_priv *sma1303 = dev_get_drvdata(dev);
|
||
|
int ret;
|
||
|
|
||
|
ret = kstrtol(buf, 10, &sma1303->check_fault_status);
|
||
|
|
||
|
if (ret)
|
||
|
return -EINVAL;
|
||
|
|
||
|
if (sma1303->check_fault_status) {
|
||
|
if (sma1303->check_fault_period > 0)
|
||
|
queue_delayed_work(system_freezable_wq,
|
||
|
&sma1303->check_fault_work,
|
||
|
sma1303->check_fault_period * HZ);
|
||
|
else
|
||
|
queue_delayed_work(system_freezable_wq,
|
||
|
&sma1303->check_fault_work,
|
||
|
CHECK_PERIOD_TIME * HZ);
|
||
|
}
|
||
|
|
||
|
return (ssize_t)count;
|
||
|
}
|
||
|
|
||
|
static DEVICE_ATTR_RW(check_fault_status);
|
||
|
|
||
|
static struct attribute *sma1303_attr[] = {
|
||
|
&dev_attr_check_fault_period.attr,
|
||
|
&dev_attr_check_fault_status.attr,
|
||
|
NULL,
|
||
|
};
|
||
|
|
||
|
static struct attribute_group sma1303_attr_group = {
|
||
|
.attrs = sma1303_attr,
|
||
|
};
|
||
|
|
||
|
static int sma1303_i2c_probe(struct i2c_client *client)
|
||
|
{
|
||
|
struct sma1303_priv *sma1303;
|
||
|
int ret, i = 0;
|
||
|
unsigned int device_info, status, otp_stat;
|
||
|
|
||
|
sma1303 = devm_kzalloc(&client->dev,
|
||
|
sizeof(struct sma1303_priv), GFP_KERNEL);
|
||
|
if (!sma1303)
|
||
|
return -ENOMEM;
|
||
|
sma1303->dev = &client->dev;
|
||
|
|
||
|
sma1303->regmap = devm_regmap_init_i2c(client, &sma_i2c_regmap);
|
||
|
if (IS_ERR(sma1303->regmap)) {
|
||
|
ret = PTR_ERR(sma1303->regmap);
|
||
|
dev_err(&client->dev,
|
||
|
"Failed to allocate register map: %d\n", ret);
|
||
|
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
ret = sma1303_regmap_read(sma1303,
|
||
|
SMA1303_FF_DEVICE_INDEX, &device_info);
|
||
|
|
||
|
if ((ret != 0) || ((device_info & 0xF8) != SMA1303_DEVICE_ID)) {
|
||
|
dev_err(&client->dev, "device initialization error (%d 0x%02X)",
|
||
|
ret, device_info);
|
||
|
}
|
||
|
dev_dbg(&client->dev, "chip version 0x%02X\n", device_info);
|
||
|
|
||
|
ret += sma1303_regmap_update_bits(sma1303,
|
||
|
SMA1303_00_SYSTEM_CTRL,
|
||
|
SMA1303_RESETBYI2C_MASK, SMA1303_RESETBYI2C_RESET,
|
||
|
NULL);
|
||
|
|
||
|
ret += sma1303_regmap_read(sma1303, SMA1303_FF_DEVICE_INDEX, &status);
|
||
|
sma1303->rev_num = status & SMA1303_REV_NUM_STATUS;
|
||
|
if (sma1303->rev_num == SMA1303_REV_NUM_TV0)
|
||
|
dev_dbg(&client->dev, "SMA1303 Trimming Version 0\n");
|
||
|
else if (sma1303->rev_num == SMA1303_REV_NUM_TV1)
|
||
|
dev_dbg(&client->dev, "SMA1303 Trimming Version 1\n");
|
||
|
|
||
|
ret += sma1303_regmap_read(sma1303, SMA1303_FB_STATUS2, &otp_stat);
|
||
|
if (ret < 0)
|
||
|
dev_err(&client->dev,
|
||
|
"failed to read, register: %02X, ret: %d\n",
|
||
|
SMA1303_FF_DEVICE_INDEX, ret);
|
||
|
|
||
|
if (((sma1303->rev_num == SMA1303_REV_NUM_TV0) &&
|
||
|
((otp_stat & 0x0E) == SMA1303_OTP_STAT_OK_0)) ||
|
||
|
((sma1303->rev_num != SMA1303_REV_NUM_TV0) &&
|
||
|
((otp_stat & 0x0C) == SMA1303_OTP_STAT_OK_1)))
|
||
|
dev_dbg(&client->dev, "SMA1303 OTP Status Successful\n");
|
||
|
else
|
||
|
dev_dbg(&client->dev, "SMA1303 OTP Status Fail\n");
|
||
|
|
||
|
for (i = 0; i < (unsigned int)ARRAY_SIZE(sma1303_reg_def); i++)
|
||
|
ret += sma1303_regmap_write(sma1303,
|
||
|
sma1303_reg_def[i].reg,
|
||
|
sma1303_reg_def[i].def);
|
||
|
|
||
|
sma1303->amp_mode = SMA1303_MONO;
|
||
|
sma1303->amp_power_status = false;
|
||
|
sma1303->check_fault_period = CHECK_PERIOD_TIME;
|
||
|
sma1303->check_fault_status = true;
|
||
|
sma1303->force_mute_status = false;
|
||
|
sma1303->init_vol = 0x31;
|
||
|
sma1303->cur_vol = sma1303->init_vol;
|
||
|
sma1303->last_bclk = 0;
|
||
|
sma1303->last_ocp_val = 0x08;
|
||
|
sma1303->last_over_temp = 0xC0;
|
||
|
sma1303->tsdw_cnt = 0;
|
||
|
sma1303->retry_cnt = SMA1303_I2C_RETRY_COUNT;
|
||
|
sma1303->tdm_slot_rx = 0;
|
||
|
sma1303->tdm_slot_tx = 0;
|
||
|
sma1303->sys_clk_id = SMA1303_PLL_CLKIN_BCLK;
|
||
|
|
||
|
sma1303->dev = &client->dev;
|
||
|
sma1303->kobj = &client->dev.kobj;
|
||
|
|
||
|
INIT_DELAYED_WORK(&sma1303->check_fault_work,
|
||
|
sma1303_check_fault_worker);
|
||
|
|
||
|
i2c_set_clientdata(client, sma1303);
|
||
|
|
||
|
sma1303->pll_matches = sma1303_pll_matches;
|
||
|
sma1303->num_of_pll_matches =
|
||
|
ARRAY_SIZE(sma1303_pll_matches);
|
||
|
|
||
|
ret = devm_snd_soc_register_component(&client->dev,
|
||
|
&sma1303_component, sma1303_dai, 1);
|
||
|
if (ret) {
|
||
|
dev_err(&client->dev, "Failed to register component");
|
||
|
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
sma1303->attr_grp = &sma1303_attr_group;
|
||
|
ret = sysfs_create_group(sma1303->kobj, sma1303->attr_grp);
|
||
|
if (ret) {
|
||
|
dev_err(&client->dev,
|
||
|
"failed to create attribute group [%d]\n", ret);
|
||
|
sma1303->attr_grp = NULL;
|
||
|
}
|
||
|
|
||
|
return ret;
|
||
|
}
|
||
|
|
||
|
static void sma1303_i2c_remove(struct i2c_client *client)
|
||
|
{
|
||
|
struct sma1303_priv *sma1303 =
|
||
|
(struct sma1303_priv *) i2c_get_clientdata(client);
|
||
|
|
||
|
cancel_delayed_work_sync(&sma1303->check_fault_work);
|
||
|
}
|
||
|
|
||
|
static const struct i2c_device_id sma1303_i2c_id[] = {
|
||
|
{"sma1303", 0},
|
||
|
{}
|
||
|
};
|
||
|
MODULE_DEVICE_TABLE(i2c, sma1303_i2c_id);
|
||
|
|
||
|
static const struct of_device_id sma1303_of_match[] = {
|
||
|
{ .compatible = "irondevice,sma1303", },
|
||
|
{ }
|
||
|
};
|
||
|
MODULE_DEVICE_TABLE(of, sma1303_of_match);
|
||
|
|
||
|
static struct i2c_driver sma1303_i2c_driver = {
|
||
|
.driver = {
|
||
|
.name = "sma1303",
|
||
|
.of_match_table = sma1303_of_match,
|
||
|
},
|
||
|
.probe = sma1303_i2c_probe,
|
||
|
.remove = sma1303_i2c_remove,
|
||
|
.id_table = sma1303_i2c_id,
|
||
|
};
|
||
|
|
||
|
module_i2c_driver(sma1303_i2c_driver);
|
||
|
|
||
|
MODULE_DESCRIPTION("ALSA SoC SMA1303 driver");
|
||
|
MODULE_AUTHOR("Gyuhwa Park, <gyuhwa.park@irondevice.com>");
|
||
|
MODULE_AUTHOR("Kiseok Jo, <kiseok.jo@irondevice.com>");
|
||
|
MODULE_LICENSE("GPL v2");
|