blob: 5366610d1d26034277e2f1e9e06041a6909fe6d2 [file] [log] [blame]
// SPDX-License-Identifier: (GPL-2.0+ OR MIT)
/*
* Copyright (c) 2019 Amlogic, Inc. All rights reserved.
*/
#include <linux/module.h>
#include <linux/moduleparam.h>
#include <linux/slab.h>
#include <linux/of.h>
#include <linux/init.h>
#include <linux/i2c.h>
#include <linux/regmap.h>
#include <sound/soc.h>
#include <sound/pcm.h>
#include <sound/initval.h>
#include <sound/pcm_params.h>
#include <linux/amlogic/aml_gpio_consumer.h>
#include "tas5805m.h"
#include "tas5805m_woofer.h"
#include "tas5805m_tweeter.h"
#define TAS5805M_DRV_NAME "tas5805m"
#define TAS5805M_RATES (SNDRV_PCM_RATE_8000 | \
SNDRV_PCM_RATE_11025 | \
SNDRV_PCM_RATE_16000 | \
SNDRV_PCM_RATE_22050 | \
SNDRV_PCM_RATE_32000 | \
SNDRV_PCM_RATE_44100 | \
SNDRV_PCM_RATE_48000 | \
SNDRV_PCM_RATE_96000)
#define TAS5805M_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | \
SNDRV_PCM_FMTBIT_S20_3LE |\
SNDRV_PCM_FMTBIT_S24_LE | \
SNDRV_PCM_FMTBIT_S32_LE)
#define TAS5805M_BIT_MSK (0x3)
#define TAS5805M_BCLK_INV (0x20)
#define TAS5805M_DATA_FMT (0x30)
#define TAS5805M_REG_00 (0x00)
#define TAS5805M_REG_02 (0x02)
#define TAS5805M_REG_03 (0x03)
#define TAS5805M_REG_08 (0x08)
#define TAS5805M_REG_24 (0x24)
#define TAS5805M_REG_25 (0x25)
#define TAS5805M_REG_26 (0x26)
#define TAS5805M_REG_27 (0x27)
#define TAS5805M_REG_28 (0x28)
#define TAS5805M_REG_29 (0x29)
#define TAS5805M_REG_2A (0x2a)
#define TAS5805M_REG_2B (0x2b)
#define TAS5805M_REG_31 (0x31)
#define TAS5805M_REG_33 (0x33)
#define TAS5805M_REG_35 (0x35)
#define TAS5805M_REG_70 (0x70)
#define TAS5805M_REG_71 (0x71)
#define TAS5805M_REG_72 (0x72)
#define TAS5805M_REG_78 (0x78)
#define TAS5805M_REG_4C (0x4c)
#define TAS5805M_REG_54 (0x54)
#define TAS5805M_REG_6B (0x6b)
#define TAS5805M_REG_6C (0x6c)
#define TAS5805M_REG_61 (0x61)
#define TAS5805M_REG_60 (0x60)
#define TAS5805M_REG_7F (0x7f)
// Special registers for engineering mode
#define TAS5805M_REG_7D (0x7d)
#define TAS5805M_REG_7E (0x7e)
#define TAS5805M_PAGE_02 (0x02)
#define TAS5805M_PAGE_11 (0x11)
#define TAS5805M_PAGE_FF (0xff)
#define TAS5805M_MAX_REG TAS5805M_REG_7F
#define TAS5805M_PAGE_00 (0x00)
#define TAS5805M_PAGE_2A (0x2a)
#define TAS5805M_BOOK_00 (0x00)
#define TAS5805M_BOOK_8C (0x8c)
#define TAS5805M_VOLUME_MAX (158)
#define TAS5805M_VOLUME_MIN (0)
#define TAS5805M_DEVICE_DEEPSLEEP_MODE (0x00)
#define TAS5805M_DEVICE_SLEEP_MODE (0x01)
#define TAS5805M_DEVICE_HIZ_MODE (0x02)
#define TAS5805M_DEVICE_PLAY_MODE (0x03)
#define TAS5805M_DEVICE_BD_MOD_MODE (0x00)
#define TAS5805M_DEVICE_HYBRID_MOD_MODE (0x02)
#define TAS5805M_SPREAD_SPECTRUM_MAX (7)
#define TAS5805M_SPREAD_SPECTRUM_MIN (0)
#define TAS5805M_STATE_MASK (0x03)
#define TAS5805M_CLEAR_FAULT (0x80)
#define TAS5805M_DIE_A1 (0x1)
#define TAS5805M_DIE_B0 (0x3)
#define TAS5805M_DAMP_PBTL_MASK (0x04)
static int master_vol = 0x6e; // 0dB
static int digital_gain = 0x30; // 0dB
static int analog_gain = 0x0a; // -5dB
enum speaker_config {
STEREO = 0,
MONO,
WOOFER,
TWEETER,
};
struct tas5805m_info {
int info_id;
};
static const u32 tas5805m_volume[] = {
0x0000001B, //0, -110dB
0x0000001E, //1, -109dB
0x00000021, //2, -108dB
0x00000025, //3, -107dB
0x0000002A, //4, -106dB
0x0000002F, //5, -105dB
0x00000035, //6, -104dB
0x0000003B, //7, -103dB
0x00000043, //8, -102dB
0x0000004B, //9, -101dB
0x00000054, //10, -100dB
0x0000005E, //11, -99dB
0x0000006A, //12, -98dB
0x00000076, //13, -97dB
0x00000085, //14, -96dB
0x00000095, //15, -95dB
0x000000A7, //16, -94dB
0x000000BC, //17, -93dB
0x000000D3, //18, -92dB
0x000000EC, //19, -91dB
0x00000109, //20, -90dB
0x0000012A, //21, -89dB
0x0000014E, //22, -88dB
0x00000177, //23, -87dB
0x000001A4, //24, -86dB
0x000001D8, //25, -85dB
0x00000211, //26, -84dB
0x00000252, //27, -83dB
0x0000029A, //28, -82dB
0x000002EC, //29, -81dB
0x00000347, //30, -80dB
0x000003AD, //31, -79dB
0x00000420, //32, -78dB
0x000004A1, //33, -77dB
0x00000532, //34, -76dB
0x000005D4, //35, -75dB
0x0000068A, //36, -74dB
0x00000756, //37, -73dB
0x0000083B, //38, -72dB
0x0000093C, //39, -71dB
0x00000A5D, //40, -70dB
0x00000BA0, //41, -69dB
0x00000D0C, //42, -68dB
0x00000EA3, //43, -67dB
0x0000106C, //44, -66dB
0x0000126D, //45, -65dB
0x000014AD, //46, -64dB
0x00001733, //47, -63dB
0x00001A07, //48, -62dB
0x00001D34, //49, -61dB
0x000020C5, //50, -60dB
0x000024C4, //51, -59dB
0x00002941, //52, -58dB
0x00002E49, //53, -57dB
0x000033EF, //54, -56dB
0x00003A45, //55, -55dB
0x00004161, //56, -54dB
0x0000495C, //57, -53dB
0x0000524F, //58, -52dB
0x00005C5A, //59, -51dB
0x0000679F, //60, -50dB
0x00007444, //61, -49dB
0x00008274, //62, -48dB
0x0000925F, //63, -47dB
0x0000A43B, //64, -46dB
0x0000B845, //65, -45dB
0x0000CEC1, //66, -44dB
0x0000E7FB, //67, -43dB
0x00010449, //68, -42dB
0x0001240C, //69, -41dB
0x000147AE, //70, -40dB
0x00016FAA, //71, -39dB
0x00019C86, //72, -38dB
0x0001CEDC, //73, -37dB
0x00020756, //74, -36dB
0x000246B5, //75, -35dB
0x00028DCF, //76, -34dB
0x0002DD96, //77, -33dB
0x00033718, //78, -32dB
0x00039B87, //79, -31dB
0x00040C37, //80, -30dB
0x00048AA7, //81, -29dB
0x00051884, //82, -28dB
0x0005B7B1, //83, -27dB
0x00066A4A, //84, -26dB
0x000732AE, //85, -25dB
0x00081385, //86, -24dB
0x00090FCC, //87, -23dB
0x000A2ADB, //88, -22dB
0x000B6873, //89, -21dB
0x000CCCCD, //90, -20dB
0x000E5CA1, //91, -19dB
0x00101D3F, //92, -18dB
0x0012149A, //93, -17dB
0x00144961, //94, -16dB
0x0016C311, //95, -15dB
0x00198A13, //96, -14dB
0x001CA7D7, //97, -13dB
0x002026F3, //98, -12dB
0x00241347, //99, -11dB
0x00287A27, //100, -10dB
0x002D6A86, //101, -9dB
0x0032F52D, //102, -8dB
0x00392CEE, //103, -7dB
0x004026E7, //104, -6dB
0x0047FACD, //105, -5dB
0x0050C336, //106, -4dB
0x005A9DF8, //107, -3dB
0x0065AC8C, //108, -2dB
0x00721483, //109, -1dB
0x00800000, //110, 0dB
0x008F9E4D, //111, 1dB
0x00A12478, //112, 2dB
0x00B4CE08, //113, 3dB
0x00CADDC8, //114, 4dB
0x00E39EA9, //115, 5dB
0x00FF64C1, //116, 6dB
0x011E8E6A, //117, 7dB
0x0141857F, //118, 8dB
0x0168C0C6, //119, 9dB
0x0194C584, //120, 10dB
0x01C62940, //121, 11dB
0x01FD93C2, //122, 12dB
0x023BC148, //123, 13dB
0x02818508, //124, 14dB
0x02CFCC01, //125, 15dB
0x0327A01A, //126, 16dB
0x038A2BAD, //127, 17dB
0x03F8BD7A, //128, 18dB
0x0474CD1B, //129, 19dB
0x05000000, //130, 20dB
0x059C2F02, //131, 21dB
0x064B6CAE, //132, 22dB
0x07100C4D, //133, 23dB
0x07ECA9CD, //134, 24dB
0x08E43299, //135, 25dB
0x09F9EF8E, //136, 26dB
0x0B319025, //137, 27dB
0x0C8F36F2, //138, 28dB
0x0E1787B8, //139, 29dB
0x0FCFB725, //140, 30dB
0x11BD9C84, //141, 31dB
0x13E7C594, //142, 32dB
0x16558CCB, //143, 33dB
0x190F3254, //144, 34dB
0x1C1DF80E, //145, 35dB
0x1F8C4107, //146, 36dB
0x2365B4BF, //147, 37dB
0x27B766C2, //148, 38dB
0x2C900313, //149, 39dB
0x32000000, //150, 40dB
0x3819D612, //151, 41dB
0x3EF23ECA, //152, 42dB
0x46A07B07, //153, 43dB
0x4F3EA203, //154, 44dB
0x58E9F9F9, //155, 45dB
0x63C35B8E, //156, 46dB
0x6FEFA16D, //157, 47dB
0x7D982575, //158, 48dB
};
#define TAS5805_EQPARAM_LENGTH 610
#define TAS5805_EQ_LENGTH 245
#define FILTER_PARAM_BYTE 244
static int m_eq_tab[TAS5805_EQPARAM_LENGTH][2];
#define TAS5805_DRC_PARAM_LENGTH 29
#define TAS5805_DRC_PARAM_COUNT 58
static int m_drc_tab[TAS5805_DRC_PARAM_LENGTH][2];
struct tas5805m_priv {
struct regmap *regmap;
struct mutex lock;/*mutex*/
struct tas5805m_platform_data *pdata;
struct device *dev;
int vol;
int mute;
int enable_lpm_mode;
int use_sleep_mode_for_lpm;
int die_rev;
struct snd_soc_component *component;
};
static bool tas5805m_reg_is_volatile(struct device *dev, unsigned int reg)
{
return reg >= TAS5805M_REG_70 && reg < TAS5805M_MAX_REG;
}
static const struct regmap_config tas5805m_regmap = {
.reg_bits = 8,
.val_bits = 8,
.cache_type = REGCACHE_RBTREE,
.volatile_reg = tas5805m_reg_is_volatile
};
static int tas5805m_get_die_revision(struct snd_soc_component *component)
{
unsigned int die_rev;
snd_soc_component_write(component, TAS5805M_REG_00, TAS5805M_PAGE_00);
snd_soc_component_write(component, TAS5805M_REG_7F, TAS5805M_BOOK_00);
snd_soc_component_write(component, TAS5805M_REG_7D, TAS5805M_PAGE_11);
snd_soc_component_write(component, TAS5805M_REG_7E, TAS5805M_PAGE_FF);
snd_soc_component_write(component, TAS5805M_REG_00, TAS5805M_PAGE_02);
die_rev = snd_soc_component_read32(component, TAS5805M_REG_08) & 0x3;
snd_soc_component_write(component, TAS5805M_REG_7E, TAS5805M_REG_00);
snd_soc_component_write(component, TAS5805M_REG_7D, TAS5805M_REG_00);
snd_soc_component_write(component, TAS5805M_REG_00, TAS5805M_PAGE_00);
snd_soc_component_write(component, TAS5805M_REG_7F, TAS5805M_BOOK_00);
snd_soc_component_write(component, TAS5805M_REG_00, TAS5805M_PAGE_00);
pr_info("%s(): 5805m die %x detected\n", __func__, die_rev);
return die_rev;
}
static int tas5805m_vol_info(struct snd_kcontrol *kcontrol,
struct snd_ctl_elem_info *uinfo)
{
uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
uinfo->access =
(SNDRV_CTL_ELEM_ACCESS_TLV_READ | SNDRV_CTL_ELEM_ACCESS_READWRITE);
uinfo->count = 1;
uinfo->value.integer.min = TAS5805M_VOLUME_MIN;
uinfo->value.integer.max = TAS5805M_VOLUME_MAX;
uinfo->value.integer.step = 1;
return 0;
}
static int tas5805m_mute_info(struct snd_kcontrol *kcontrol,
struct snd_ctl_elem_info *uinfo)
{
uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
uinfo->access =
(SNDRV_CTL_ELEM_ACCESS_TLV_READ | SNDRV_CTL_ELEM_ACCESS_READWRITE);
uinfo->count = 1;
uinfo->value.integer.min = 0;
uinfo->value.integer.max = 1;
uinfo->value.integer.step = 1;
return 0;
}
static int tas5805m_lpm_mode_locked_get(struct snd_kcontrol *kcontrol,
struct snd_ctl_elem_value *ucontrol)
{
struct snd_soc_component *component =
snd_soc_kcontrol_component(kcontrol);
struct tas5805m_priv *tas5805m =
snd_soc_component_get_drvdata(component);
mutex_lock(&tas5805m->lock);
ucontrol->value.integer.value[0] = tas5805m->enable_lpm_mode;
mutex_unlock(&tas5805m->lock);
pr_info("%s(): LPM mode is %s", __func__,
tas5805m->enable_lpm_mode ? "Enabled" : "Disabled");
return 0;
}
static int tas5805m_vol_locked_get(struct snd_kcontrol *kcontrol,
struct snd_ctl_elem_value *ucontrol)
{
struct snd_soc_component *component =
snd_soc_kcontrol_component(kcontrol);
struct tas5805m_priv *tas5805m =
snd_soc_component_get_drvdata(component);
ucontrol->value.integer.value[0] = tas5805m->vol;
return 0;
}
static inline int get_volume_index(int vol)
{
int index;
index = vol;
if (index < TAS5805M_VOLUME_MIN)
index = TAS5805M_VOLUME_MIN;
if (index > TAS5805M_VOLUME_MAX)
index = TAS5805M_VOLUME_MAX;
return index;
}
static void tas5805m_set_volume(struct snd_soc_component *component, int vol)
{
unsigned int index;
u32 volume_hex;
u8 byte4;
u8 byte3;
u8 byte2;
u8 byte1;
index = get_volume_index(vol);
volume_hex = tas5805m_volume[index];
byte4 = ((volume_hex >> 24) & 0xFF);
byte3 = ((volume_hex >> 16) & 0xFF);
byte2 = ((volume_hex >> 8) & 0xFF);
byte1 = ((volume_hex >> 0) & 0xFF);
//w 58 00 00
snd_soc_component_write(component, TAS5805M_REG_00, TAS5805M_PAGE_00);
//w 58 7f 8c
snd_soc_component_write(component, TAS5805M_REG_7F, TAS5805M_BOOK_8C);
//w 58 00 2a
snd_soc_component_write(component, TAS5805M_REG_00, TAS5805M_PAGE_2A);
//w 58 24 xx
snd_soc_component_write(component, TAS5805M_REG_24, byte4);
snd_soc_component_write(component, TAS5805M_REG_25, byte3);
snd_soc_component_write(component, TAS5805M_REG_26, byte2);
snd_soc_component_write(component, TAS5805M_REG_27, byte1);
//w 58 28 xx
snd_soc_component_write(component, TAS5805M_REG_28, byte4);
snd_soc_component_write(component, TAS5805M_REG_29, byte3);
snd_soc_component_write(component, TAS5805M_REG_2A, byte2);
snd_soc_component_write(component, TAS5805M_REG_2B, byte1);
}
static int tas5805m_vol_locked_put(struct snd_kcontrol *kcontrol,
struct snd_ctl_elem_value *ucontrol)
{
struct snd_soc_component *component =
snd_soc_kcontrol_component(kcontrol);
struct tas5805m_priv *tas5805m =
snd_soc_component_get_drvdata(component);
tas5805m->vol = ucontrol->value.integer.value[0];
tas5805m_set_volume(component, tas5805m->vol);
return 0;
}
static int tas5805m_lpm_mode_locked_put(struct snd_kcontrol *kcontrol,
struct snd_ctl_elem_value *ucontrol)
{
struct snd_soc_component *component =
snd_soc_kcontrol_component(kcontrol);
struct tas5805m_priv *tas5805m =
snd_soc_component_get_drvdata(component);
int enable_lpm_mode = ucontrol->value.integer.value[0];
mutex_lock(&tas5805m->lock);
tas5805m->enable_lpm_mode = enable_lpm_mode;
mutex_unlock(&tas5805m->lock);
pr_info("%s(): LPM mode is %s", __func__,
enable_lpm_mode ? "Enabled" : "Disabled");
return 0;
}
static int tas5805m_mute(struct snd_soc_component *component, int mute)
{
u8 reg03_value = 0;
u8 reg35_value = 0;
if (mute) {
//mute both left & right channels
reg03_value = 0x0b;
reg35_value = 0x00;
} else {
//unmute
reg03_value = 0x03;
reg35_value = 0x11;
}
snd_soc_component_write(component, TAS5805M_REG_00, TAS5805M_PAGE_00);
snd_soc_component_write(component, TAS5805M_REG_7F, TAS5805M_BOOK_00);
snd_soc_component_write(component, TAS5805M_REG_00, TAS5805M_PAGE_00);
snd_soc_component_write(component, TAS5805M_REG_03, reg03_value);
snd_soc_component_write(component, TAS5805M_REG_35, reg35_value);
return 0;
}
static int tas5805m_mute_locked_put(struct snd_kcontrol *kcontrol,
struct snd_ctl_elem_value *ucontrol)
{
struct snd_soc_component *component =
snd_soc_kcontrol_component(kcontrol);
struct tas5805m_priv *tas5805m =
snd_soc_component_get_drvdata(component);
tas5805m->mute = ucontrol->value.integer.value[0];
tas5805m_mute(component, tas5805m->mute);
return 0;
}
static int tas5805m_mute_locked_get(struct snd_kcontrol *kcontrol,
struct snd_ctl_elem_value *ucontrol)
{
struct snd_soc_component *component =
snd_soc_kcontrol_component(kcontrol);
struct tas5805m_priv *tas5805m =
snd_soc_component_get_drvdata(component);
ucontrol->value.integer.value[0] = tas5805m->mute;
return 0;
}
static const char *const spread_spectrum_texts[] = {
"24k_5%",
"24k_10%",
"24k_20%",
"24k_25%",
"48k_5%",
"48k_10%",
"48k_20%",
"48k_25%",
};
static const struct soc_enum spread_spectrum_enum =
SOC_ENUM_SINGLE(TAS5805M_REG_6C,
0,
ARRAY_SIZE(spread_spectrum_texts),
spread_spectrum_texts);
static int tas5805m_spread_spectrum_put(struct snd_kcontrol *kcontrol,
struct snd_ctl_elem_value *ucontrol)
{
struct snd_soc_component *component =
snd_soc_kcontrol_component(kcontrol);
u8 val = ucontrol->value.integer.value[0];
snd_soc_component_update_bits(component, TAS5805M_REG_6C, 0xf, val);
return 0;
}
static int tas5805m_spread_spectrum_get(struct snd_kcontrol *kcontrol,
struct snd_ctl_elem_value *ucontrol)
{
struct snd_soc_component *component =
snd_soc_kcontrol_component(kcontrol);
u8 val;
val = snd_soc_component_read32(component, TAS5805M_REG_6C);
ucontrol->value.integer.value[0] = (val & 0xf);
return 0;
}
static int tas5805_set_spread_spectrum(struct snd_kcontrol *kcontrol,
struct snd_ctl_elem_value *ucontrol)
{
struct snd_soc_component *component =
snd_soc_kcontrol_component(kcontrol);
u8 val;
val = (ucontrol->value.integer.value[0]) ? 0x3 : 0;
snd_soc_component_update_bits(component, TAS5805M_REG_6B, 0x3, val);
return 0;
}
static int tas5805_get_spread_spectrum(struct snd_kcontrol *kcontrol,
struct snd_ctl_elem_value *ucontrol)
{
struct snd_soc_component *component =
snd_soc_kcontrol_component(kcontrol);
u8 val1, val2;
val1 = snd_soc_component_read32(component, TAS5805M_REG_6B);
val2 = ((val1 & 0x3) == 0x3) ? 1 : 0;
ucontrol->value.integer.value[0] = val2;
return 0;
}
static int tas5805_set_EQ_enum(struct snd_kcontrol *kcontrol,
struct snd_ctl_elem_value *ucontrol)
{
return 0;
}
static int tas5805_get_EQ_enum(struct snd_kcontrol *kcontrol,
struct snd_ctl_elem_value *ucontrol)
{
return 0;
}
static int tas5805_set_DRC_enum(struct snd_kcontrol *kcontrol,
struct snd_ctl_elem_value *ucontrol)
{
return 0;
}
static int tas5805_get_DRC_enum(struct snd_kcontrol *kcontrol,
struct snd_ctl_elem_value *ucontrol)
{
return 0;
}
static int tas5805_set_DRC_param(struct snd_kcontrol *kcontrol,
struct snd_ctl_elem_value *ucontrol)
{
struct snd_soc_component *component =
snd_soc_kcontrol_component(kcontrol);
void *data;
char tmp_string[TAS5805_DRC_PARAM_COUNT];
char *p_string = &tmp_string[0];
u8 *val;
unsigned int i = 0;
data = kmemdup(ucontrol->value.bytes.data,
TAS5805_DRC_PARAM_COUNT, GFP_KERNEL | GFP_DMA);
if (!data)
return -ENOMEM;
val = (u8 *)data;
memcpy(p_string, val, TAS5805_DRC_PARAM_COUNT);
for (i = 0; i < TAS5805_DRC_PARAM_COUNT / 2; i++) {
m_drc_tab[i][0] = tmp_string[2 * i];
m_drc_tab[i][1] = tmp_string[2 * i + 1];
}
for (i = 0; i < TAS5805_DRC_PARAM_LENGTH; i++)
snd_soc_component_write(component,
m_drc_tab[i][0], m_drc_tab[i][1]);
kfree(data);
return 0;
}
static int tas5805_get_DRC_param(struct snd_kcontrol *kcontrol,
struct snd_ctl_elem_value *ucontrol)
{
return 0;
}
static int tas5805_set_EQ_param(struct snd_kcontrol *kcontrol,
struct snd_ctl_elem_value *ucontrol)
{
struct snd_soc_component *component =
snd_soc_kcontrol_component(kcontrol);
void *data;
char tmp_string[TAS5805_EQ_LENGTH];
char *p_string = &tmp_string[0];
u8 *val;
int band_id;
unsigned int i = 0, j = 0;
data = kmemdup(ucontrol->value.bytes.data,
TAS5805_EQ_LENGTH, GFP_KERNEL | GFP_DMA);
if (!data)
return -ENOMEM;
val = (u8 *)data;
memcpy(p_string, val, TAS5805_EQ_LENGTH);
band_id = tmp_string[0];
for (j = 0, i = band_id * FILTER_PARAM_BYTE / 2;
j < FILTER_PARAM_BYTE / 2; i++, j++) {
m_eq_tab[i][0] = tmp_string[2 * j + 1];
m_eq_tab[i][1] = tmp_string[2 * j + 2];
}
if (band_id == 4) {
for (i = 0; i < TAS5805_EQPARAM_LENGTH; i++)
snd_soc_component_write(component,
m_eq_tab[i][0], m_eq_tab[i][1]);
}
kfree(data);
return 0;
}
static int tas5805_get_EQ_param(struct snd_kcontrol *kcontrol,
struct snd_ctl_elem_value *ucontrol)
{
return 0;
}
static void tas5805m_configure_deepsleep_mode
(struct snd_soc_component *component,
int sleep)
{
struct tas5805m_priv *tas5805m =
snd_soc_component_get_drvdata(component);
int sleep_mode;
snd_soc_component_write(component, TAS5805M_REG_00, TAS5805M_PAGE_00);
snd_soc_component_write(component, TAS5805M_REG_7F, TAS5805M_BOOK_00);
mutex_lock(&tas5805m->lock);
sleep_mode = tas5805m->use_sleep_mode_for_lpm;
mutex_unlock(&tas5805m->lock);
pr_info("%s(): 5805m triggered %s mode\n", __func__,
sleep ? (sleep_mode ? "sleep" : "deep sleep") : "play");
if (!sleep) {
snd_soc_component_write(component,
TAS5805M_REG_02, TAS5805M_DEVICE_BD_MOD_MODE);
snd_soc_component_write(component,
TAS5805M_REG_03, TAS5805M_DEVICE_HIZ_MODE);
usleep_range(2000, 2200);
snd_soc_component_write(component,
TAS5805M_REG_02, TAS5805M_DEVICE_HYBRID_MOD_MODE);
if (tas5805m->pdata->pbtl_mode) {
snd_soc_component_update_bits(component,
TAS5805M_REG_02, TAS5805M_DAMP_PBTL_MASK, 0x07);
}
usleep_range(15000, 15200);
snd_soc_component_write(component,
TAS5805M_REG_03, TAS5805M_DEVICE_PLAY_MODE);
} else {
snd_soc_component_write(component,
TAS5805M_REG_03, TAS5805M_DEVICE_HIZ_MODE);
snd_soc_component_write(component,
TAS5805M_REG_03, sleep_mode);
}
}
static int get_lpm_mode_status_locked(struct snd_soc_component *component)
{
int enable_lpm_mode = 0; /* By default disable lpm mode */
struct tas5805m_priv *tas5805m =
snd_soc_component_get_drvdata(component);
mutex_lock(&tas5805m->lock);
enable_lpm_mode = tas5805m->enable_lpm_mode;
mutex_unlock(&tas5805m->lock);
return enable_lpm_mode;
}
static const struct snd_kcontrol_new tas5805m_control[] = {
{
.iface = SNDRV_CTL_ELEM_IFACE_MIXER,
.name = "Master Volume",
.info = tas5805m_vol_info,
.get = tas5805m_vol_locked_get,
.put = tas5805m_vol_locked_put,
},
{
.iface = SNDRV_CTL_ELEM_IFACE_MIXER,
.name = "Maser Volume Mute",
.info = tas5805m_mute_info,
.get = tas5805m_mute_locked_get,
.put = tas5805m_mute_locked_put,
},
SOC_ENUM_EXT("Spread Spectrum",
spread_spectrum_enum,
tas5805m_spread_spectrum_get,
tas5805m_spread_spectrum_put),
SOC_SINGLE_BOOL_EXT("Spread Spectrum Enable", 0,
tas5805_get_spread_spectrum,
tas5805_set_spread_spectrum),
SOC_SINGLE_BOOL_EXT("Set EQ Enable", 0,
tas5805_get_EQ_enum,
tas5805_set_EQ_enum),
SOC_SINGLE_BOOL_EXT("Set DRC Enable", 0,
tas5805_get_DRC_enum,
tas5805_set_DRC_enum),
SND_SOC_BYTES_EXT("EQ table", TAS5805_EQ_LENGTH,
tas5805_get_EQ_param,
tas5805_set_EQ_param),
SND_SOC_BYTES_EXT("DRC table", TAS5805_DRC_PARAM_COUNT,
tas5805_get_DRC_param,
tas5805_set_DRC_param),
/* LPM mode toggle */
SOC_SINGLE_BOOL_EXT("TAS5805m LPM mode", 0,
tas5805m_lpm_mode_locked_get,
tas5805m_lpm_mode_locked_put),
};
static int tas5805m_set_bias_level(struct snd_soc_component *component,
enum snd_soc_bias_level level)
{
pr_debug("level = %d\n", level);
switch (level) {
case SND_SOC_BIAS_ON:
break;
case SND_SOC_BIAS_PREPARE:
/* Full power on */
break;
case SND_SOC_BIAS_STANDBY:
break;
case SND_SOC_BIAS_OFF:
/* The chip runs through the power down sequence for us. */
break;
}
component->dapm.bias_level = level;
return 0;
}
static int tas5805m_trigger(struct snd_pcm_substream *substream, int cmd,
struct snd_soc_dai *codec_dai)
{
//struct tas5805m_priv *tas5805m = snd_soc_dai_get_drvdata(codec_dai);
//struct snd_soc_component *component = tas5805m->component;
if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) {
switch (cmd) {
case SNDRV_PCM_TRIGGER_START:
case SNDRV_PCM_TRIGGER_RESUME:
case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
pr_debug("%s(), start\n", __func__);
break;
case SNDRV_PCM_TRIGGER_STOP:
case SNDRV_PCM_TRIGGER_SUSPEND:
case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
pr_debug("%s(), stop\n", __func__);
break;
}
}
return 0;
}
static int reset_tas5805m_GPIO(struct device *dev)
{
struct tas5805m_priv *tas5805m = dev_get_drvdata(dev);
struct tas5805m_platform_data *pdata = tas5805m->pdata;
int ret = 0;
if (pdata->reset_pin < 0) {
pr_warn("%s(), no reset pin\n", __func__);
return -1;
}
ret = devm_gpio_request_one(dev, pdata->reset_pin,
GPIOF_OUT_INIT_LOW,
"tas5805m-reset-pin");
if (ret < 0) {
pr_warn("%s(), request reset-pin failed\n", __func__);
return -1;
}
/* GPIOM_10 is set to low in uboot stage */
gpio_direction_output(pdata->reset_pin, GPIOF_OUT_INIT_LOW);
usleep_range(5 * 1000, 6 * 1000);
gpio_direction_output(pdata->reset_pin, GPIOF_OUT_INIT_HIGH);
usleep_range(5 * 1000, 6 * 1000);
pr_info("%s(), tas5805m sets PDN ok\n", __func__);
return 0;
}
static int tas5805m_snd_suspend(struct snd_soc_component *component)
{
struct tas5805m_priv *tas5805m =
snd_soc_component_get_drvdata(component);
struct tas5805m_platform_data *pdata = tas5805m->pdata;
dev_info(component->dev, "tas5805m_suspend!\n");
tas5805m_set_bias_level(component, SND_SOC_BIAS_OFF);
if (pdata->reset_pin)
gpio_direction_output(pdata->reset_pin, GPIOF_OUT_INIT_LOW);
usleep_range(9, 15);
return 0;
}
static int tas5805m_apply_seq(struct snd_soc_component *component,
const int (*tas5805m_seq)[2],
size_t size_seq)
{
int i, ret;
for (i = 0; i < size_seq; i++) {
ret = snd_soc_component_write(component, tas5805m_seq[i][0],
tas5805m_seq[i][1]);
if (ret < 0) {
dev_err(component->dev, "i2c write failed reg: 0x%x val: 0x%x\n",
tas5805m_seq[i][0], tas5805m_seq[i][1]);
return ret;
}
}
return 0;
}
static int tas5805m_reg_init(struct snd_soc_component *component)
{
struct tas5805m_priv *tas5805m =
snd_soc_component_get_drvdata(component);
tas5805m_apply_seq(component, tas5805m_reset,
ARRAY_SIZE(tas5805m_reset));
msleep(20);
switch (tas5805m->pdata->spk_config) {
case MONO:
tas5805m_apply_seq(component, tas5805m_init_mono,
ARRAY_SIZE(tas5805m_init_mono));
break;
case WOOFER:
tas5805m_apply_seq(component, tas5805m_init_woofer,
ARRAY_SIZE(tas5805m_init_woofer));
break;
case TWEETER:
tas5805m_apply_seq(component, tas5805m_init_tweeter,
ARRAY_SIZE(tas5805m_init_tweeter));
break;
case STEREO:
default:
tas5805m_apply_seq(component, tas5805m_init_sequence,
ARRAY_SIZE(tas5805m_init_sequence));
};
msleep(50);
return 0;
}
static int tas5805m_snd_resume(struct snd_soc_component *component)
{
int ret;
struct tas5805m_priv *tas5805m =
snd_soc_component_get_drvdata(component);
struct tas5805m_platform_data *pdata = tas5805m->pdata;
dev_info(component->dev, "%s!\n", __func__);
if (pdata->reset_pin)
gpio_direction_output(pdata->reset_pin, GPIOF_OUT_INIT_HIGH);
usleep_range(3 * 1000, 4 * 1000);
ret = tas5805m_reg_init(component);
// regmap_register_patch(tas5805m->regmap, tas5805m_init_sequence,
// ARRAY_SIZE(tas5805m_init_sequence));
if (ret != 0) {
dev_err(component->dev,
"Failed to initialize TAS5805M: %d\n", ret);
goto err;
}
tas5805m_set_volume(component, tas5805m->vol);
snd_soc_component_write(component, TAS5805M_REG_00, TAS5805M_PAGE_00);
snd_soc_component_write(component, TAS5805M_REG_7F, TAS5805M_BOOK_00);
snd_soc_component_write(component, TAS5805M_REG_00, TAS5805M_PAGE_00);
snd_soc_component_write(component, TAS5805M_REG_4C, digital_gain);
snd_soc_component_write(component, TAS5805M_REG_54, analog_gain);
tas5805m_set_bias_level(component, SND_SOC_BIAS_STANDBY);
return 0;
err:
return ret;
}
static int tas5805m_probe(struct snd_soc_component *component)
{
int ret;
struct tas5805m_priv *tas5805m =
snd_soc_component_get_drvdata(component);
usleep_range(20 * 1000, 21 * 1000);
ret = tas5805m_reg_init(component);
if (ret != 0)
goto err;
/* set master vol */
tas5805m_set_volume(component, tas5805m->vol);
/* set digital gain & analog gain */
snd_soc_component_write(component, TAS5805M_REG_00, TAS5805M_PAGE_00);
snd_soc_component_write(component, TAS5805M_REG_7F, TAS5805M_BOOK_00);
snd_soc_component_write(component, TAS5805M_REG_00, TAS5805M_PAGE_00);
snd_soc_component_write(component, TAS5805M_REG_4C, digital_gain);
snd_soc_component_write(component, TAS5805M_REG_54, analog_gain);
/*set spread spectrum default to enable*/
snd_soc_component_update_bits(component, TAS5805M_REG_6B, 0x3, 0x3);
snd_soc_component_update_bits(component, TAS5805M_REG_6C, 0xf, 1);
/*enable FAULT PIN*/
snd_soc_component_write(component, TAS5805M_REG_61, 0xb);
snd_soc_component_write(component, TAS5805M_REG_60, 0x1);
snd_soc_add_component_controls(component, tas5805m_control,
ARRAY_SIZE(tas5805m_control));
/* By default use deep sleep for LPM */
tas5805m->use_sleep_mode_for_lpm = TAS5805M_DEVICE_DEEPSLEEP_MODE;
/* get DIE version */
tas5805m->die_rev = tas5805m_get_die_revision(component);
/* By default enable LPM mode */
tas5805m->enable_lpm_mode = 1;
tas5805m->component = component;
mutex_init(&tas5805m->lock);
return 0;
err:
return ret;
}
static void tas5805m_remove(struct snd_soc_component *component)
{
struct tas5805m_priv *tas5805m =
snd_soc_component_get_drvdata(component);
struct tas5805m_platform_data *pdata = tas5805m->pdata;
if (pdata->reset_pin)
gpio_direction_output(pdata->reset_pin, GPIOF_OUT_INIT_LOW);
usleep_range(9, 15);
}
static const struct snd_soc_component_driver soc_codec_tas5805m = {
.probe = tas5805m_probe,
.remove = tas5805m_remove,
.suspend = tas5805m_snd_suspend,
.resume = tas5805m_snd_resume,
.set_bias_level = tas5805m_set_bias_level,
};
static int tas5805m_set_dai_fmt(struct snd_soc_dai *codec_dai,
unsigned int fmt)
{
struct snd_soc_component *component = codec_dai->component;
u8 iface_reg1 = 0;
u8 iface_reg2 = 0;
switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
case SND_SOC_DAIFMT_NB_NF:
break;
case SND_SOC_DAIFMT_IB_NF:
iface_reg1 |= 1;
break;
default:
dev_warn(component->dev, "%s: Invalid DAI clock signal polarity\n",
__func__);
}
switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
case SND_SOC_DAIFMT_I2S:
break;
case SND_SOC_DAIFMT_DSP_A:
case SND_SOC_DAIFMT_DSP_B:
iface_reg2 |= 1;
break;
case SND_SOC_DAIFMT_RIGHT_J:
iface_reg2 |= 2;
break;
case SND_SOC_DAIFMT_LEFT_J:
iface_reg2 |= 3;
break;
default:
dev_warn(component->dev, "%s: No Format. Using default I2S\n",
__func__);
}
snd_soc_component_update_bits(component, TAS5805M_REG_31,
TAS5805M_BCLK_INV, iface_reg1);
snd_soc_component_update_bits(component, TAS5805M_REG_33,
TAS5805M_DATA_FMT, iface_reg2);
return 0;
}
static int tas5805m_hw_params(struct snd_pcm_substream *substream,
struct snd_pcm_hw_params *params,
struct snd_soc_dai *codec_dai)
{
struct snd_soc_component *component = codec_dai->component;
//struct tas5805m_priv *tas5805m =
//snd_soc_component_get_drvdata(component);
unsigned int bit_depth = params_width(params);
int iface_reg = 0;
/* bit depth set */
switch (bit_depth) {
case 16:
break;
case 20:
iface_reg = 1;
break;
case 24:
iface_reg = 2;
break;
case 32:
iface_reg = 3;
break;
default:
dev_warn(component->dev, "%s: Invalid bit_depth, using default 16bit\n",
__func__);
}
snd_soc_component_update_bits(component, TAS5805M_REG_33,
TAS5805M_BIT_MSK, iface_reg);
/* get rid of hissing sound for ultrasonic content */
tas5805m_apply_seq(component, tas5805m_init_rc_filter,
ARRAY_SIZE(tas5805m_init_rc_filter));
if (get_lpm_mode_status_locked(component))
tas5805m_configure_deepsleep_mode(component, false);
return 0;
}
static int tas5805m_hw_free(struct snd_pcm_substream *substream,
struct snd_soc_dai *dai)
{
int ret = 0;
struct snd_soc_component *component = dai->component;
if (get_lpm_mode_status_locked(component))
tas5805m_configure_deepsleep_mode(component, true);
return ret;
}
static const struct snd_soc_dai_ops tas5805m_dai_ops = {
.hw_params = tas5805m_hw_params,
.set_fmt = tas5805m_set_dai_fmt,
//.digital_mute = tas5805m_mute,
.trigger = tas5805m_trigger,
.hw_free = tas5805m_hw_free,
};
static struct snd_soc_dai_driver tas5805m_dai = {
.name = "tas5805m-amplifier",
.playback = {
.stream_name = "Playback",
.channels_min = 2,
.channels_max = 8,
.rates = TAS5805M_RATES,
.formats = TAS5805M_FORMATS,
},
.ops = &tas5805m_dai_ops,
};
static int tas5805m_parse_dt(struct tas5805m_priv *tas5805m)
{
int ret = 0;
int reset_pin = -1;
int power_pin = -1;
reset_pin = of_get_named_gpio(tas5805m->dev->of_node, "reset-gpio", 0);
if (reset_pin < 0)
pr_warn("%s fail to get reset pin from dts!\n", __func__);
tas5805m->pdata->reset_pin = reset_pin;
power_pin = of_get_named_gpio(tas5805m->dev->of_node, "power-gpio", 0);
tas5805m->pdata->power_pin = power_pin;
gpio_direction_output(power_pin, GPIOF_OUT_INIT_HIGH);
ret = device_property_read_u32(tas5805m->dev, "speaker-config",
&tas5805m->pdata->spk_config);
if (ret)
pr_warn("%s: speaker-config not found. Setting to default\n",
__func__);
if (device_property_read_bool(tas5805m->dev, "pbtl-mode"))
tas5805m->pdata->pbtl_mode = true;
else
tas5805m->pdata->pbtl_mode = false;
dev_info(tas5805m->dev, "%s: pbtl mode %d\n", __func__,
tas5805m->pdata->pbtl_mode);
return ret;
}
static int tas5805m_i2c_probe(struct i2c_client *i2c,
const struct i2c_device_id *id)
{
struct regmap *regmap;
struct regmap_config config = tas5805m_regmap;
struct tas5805m_priv *tas5805m;
struct tas5805m_platform_data *pdata;
int ret = 0;
tas5805m = devm_kzalloc(&i2c->dev,
sizeof(struct tas5805m_priv), GFP_KERNEL);
if (!tas5805m)
return -ENOMEM;
regmap = devm_regmap_init_i2c(i2c, &config);
if (IS_ERR(regmap))
return PTR_ERR(regmap);
pdata = devm_kzalloc(&i2c->dev,
sizeof(struct tas5805m_platform_data),
GFP_KERNEL);
if (!pdata) {
pr_err("%s failed to kzalloc for tas5805 pdata\n", __func__);
return -ENOMEM;
}
tas5805m->pdata = pdata;
tas5805m->dev = &i2c->dev;
tas5805m_parse_dt(tas5805m);
tas5805m->regmap = regmap;
tas5805m->vol = master_vol;
dev_set_drvdata(&i2c->dev, tas5805m);
reset_tas5805m_GPIO(&i2c->dev);
ret = snd_soc_register_component(&i2c->dev, &soc_codec_tas5805m,
&tas5805m_dai, 1);
if (ret != 0)
return -ENOMEM;
return ret;
}
static int tas5805m_i2c_remove(struct i2c_client *i2c)
{
devm_kfree(&i2c->dev, i2c_get_clientdata(i2c));
return 0;
}
static const struct i2c_device_id tas5805m_i2c_id[] = {
{"tas5805m",},
{}
};
static struct tas5805m_info info[] = {
{
.info_id = 0,
},
{
.info_id = 1,
},
{}
};
MODULE_DEVICE_TABLE(i2c, tas5805m_i2c_id);
#ifdef CONFIG_OF
static const struct of_device_id tas5805m_of_match[] = {
{
.compatible = "ti,tas5805m_0",
.data = &info[0],
},
{
.compatible = "ti,tas5805m_1",
.data = &info[1],
},
{}
};
MODULE_DEVICE_TABLE(of, tas5805m_of_match);
#endif
static struct i2c_driver tas5805m_i2c_driver = {
.probe = tas5805m_i2c_probe,
.remove = tas5805m_i2c_remove,
.id_table = tas5805m_i2c_id,
.driver = {
.name = TAS5805M_DRV_NAME,
.of_match_table = tas5805m_of_match,
},
};
module_i2c_driver(tas5805m_i2c_driver);
MODULE_AUTHOR("Andy Liu <andy-liu@ti.com>");
MODULE_DESCRIPTION("TAS5805M Audio Amplifier Driver");
MODULE_LICENSE("GPL v2");