0001
0002
0003
0004
0005
0006
0007
0008
0009
0010 #include <linux/module.h>
0011 #include <linux/moduleparam.h>
0012 #include <linux/init.h>
0013 #include <linux/delay.h>
0014 #include <linux/pm.h>
0015 #include <linux/firmware.h>
0016 #include <linux/gcd.h>
0017 #include <linux/gpio.h>
0018 #include <linux/i2c.h>
0019 #include <linux/pm_runtime.h>
0020 #include <linux/regulator/consumer.h>
0021 #include <linux/regulator/fixed.h>
0022 #include <linux/slab.h>
0023 #include <sound/core.h>
0024 #include <sound/pcm.h>
0025 #include <sound/pcm_params.h>
0026 #include <sound/soc.h>
0027 #include <sound/jack.h>
0028 #include <sound/initval.h>
0029 #include <sound/tlv.h>
0030 #include <sound/wm2200.h>
0031
0032 #include "wm2200.h"
0033 #include "wm_adsp.h"
0034
0035 #define WM2200_DSP_CONTROL_1 0x00
0036 #define WM2200_DSP_CONTROL_2 0x02
0037 #define WM2200_DSP_CONTROL_3 0x03
0038 #define WM2200_DSP_CONTROL_4 0x04
0039 #define WM2200_DSP_CONTROL_5 0x06
0040 #define WM2200_DSP_CONTROL_6 0x07
0041 #define WM2200_DSP_CONTROL_7 0x08
0042 #define WM2200_DSP_CONTROL_8 0x09
0043 #define WM2200_DSP_CONTROL_9 0x0A
0044 #define WM2200_DSP_CONTROL_10 0x0B
0045 #define WM2200_DSP_CONTROL_11 0x0C
0046 #define WM2200_DSP_CONTROL_12 0x0D
0047 #define WM2200_DSP_CONTROL_13 0x0F
0048 #define WM2200_DSP_CONTROL_14 0x10
0049 #define WM2200_DSP_CONTROL_15 0x11
0050 #define WM2200_DSP_CONTROL_16 0x12
0051 #define WM2200_DSP_CONTROL_17 0x13
0052 #define WM2200_DSP_CONTROL_18 0x14
0053 #define WM2200_DSP_CONTROL_19 0x16
0054 #define WM2200_DSP_CONTROL_20 0x17
0055 #define WM2200_DSP_CONTROL_21 0x18
0056 #define WM2200_DSP_CONTROL_22 0x1A
0057 #define WM2200_DSP_CONTROL_23 0x1B
0058 #define WM2200_DSP_CONTROL_24 0x1C
0059 #define WM2200_DSP_CONTROL_25 0x1E
0060 #define WM2200_DSP_CONTROL_26 0x20
0061 #define WM2200_DSP_CONTROL_27 0x21
0062 #define WM2200_DSP_CONTROL_28 0x22
0063 #define WM2200_DSP_CONTROL_29 0x23
0064 #define WM2200_DSP_CONTROL_30 0x24
0065 #define WM2200_DSP_CONTROL_31 0x26
0066
0067
0068 #define WM2200_NUM_CORE_SUPPLIES 2
0069 static const char *wm2200_core_supply_names[WM2200_NUM_CORE_SUPPLIES] = {
0070 "DBVDD",
0071 "LDOVDD",
0072 };
0073
0074
0075 struct wm2200_priv {
0076 struct wm_adsp dsp[2];
0077 struct regmap *regmap;
0078 struct device *dev;
0079 struct snd_soc_component *component;
0080 struct wm2200_pdata pdata;
0081 struct regulator_bulk_data core_supplies[WM2200_NUM_CORE_SUPPLIES];
0082
0083 struct completion fll_lock;
0084 int fll_fout;
0085 int fll_fref;
0086 int fll_src;
0087
0088 int rev;
0089 int sysclk;
0090
0091 unsigned int symmetric_rates:1;
0092 };
0093
0094 #define WM2200_DSP_RANGE_BASE (WM2200_MAX_REGISTER + 1)
0095 #define WM2200_DSP_SPACING 12288
0096
0097 #define WM2200_DSP1_DM_BASE (WM2200_DSP_RANGE_BASE + (0 * WM2200_DSP_SPACING))
0098 #define WM2200_DSP1_PM_BASE (WM2200_DSP_RANGE_BASE + (1 * WM2200_DSP_SPACING))
0099 #define WM2200_DSP1_ZM_BASE (WM2200_DSP_RANGE_BASE + (2 * WM2200_DSP_SPACING))
0100 #define WM2200_DSP2_DM_BASE (WM2200_DSP_RANGE_BASE + (3 * WM2200_DSP_SPACING))
0101 #define WM2200_DSP2_PM_BASE (WM2200_DSP_RANGE_BASE + (4 * WM2200_DSP_SPACING))
0102 #define WM2200_DSP2_ZM_BASE (WM2200_DSP_RANGE_BASE + (5 * WM2200_DSP_SPACING))
0103
0104 static const struct regmap_range_cfg wm2200_ranges[] = {
0105 { .name = "DSP1DM", .range_min = WM2200_DSP1_DM_BASE,
0106 .range_max = WM2200_DSP1_DM_BASE + 12287,
0107 .selector_reg = WM2200_DSP1_CONTROL_3,
0108 .selector_mask = WM2200_DSP1_PAGE_BASE_DM_0_MASK,
0109 .selector_shift = WM2200_DSP1_PAGE_BASE_DM_0_SHIFT,
0110 .window_start = WM2200_DSP1_DM_0, .window_len = 2048, },
0111
0112 { .name = "DSP1PM", .range_min = WM2200_DSP1_PM_BASE,
0113 .range_max = WM2200_DSP1_PM_BASE + 12287,
0114 .selector_reg = WM2200_DSP1_CONTROL_2,
0115 .selector_mask = WM2200_DSP1_PAGE_BASE_PM_0_MASK,
0116 .selector_shift = WM2200_DSP1_PAGE_BASE_PM_0_SHIFT,
0117 .window_start = WM2200_DSP1_PM_0, .window_len = 768, },
0118
0119 { .name = "DSP1ZM", .range_min = WM2200_DSP1_ZM_BASE,
0120 .range_max = WM2200_DSP1_ZM_BASE + 2047,
0121 .selector_reg = WM2200_DSP1_CONTROL_4,
0122 .selector_mask = WM2200_DSP1_PAGE_BASE_ZM_0_MASK,
0123 .selector_shift = WM2200_DSP1_PAGE_BASE_ZM_0_SHIFT,
0124 .window_start = WM2200_DSP1_ZM_0, .window_len = 1024, },
0125
0126 { .name = "DSP2DM", .range_min = WM2200_DSP2_DM_BASE,
0127 .range_max = WM2200_DSP2_DM_BASE + 4095,
0128 .selector_reg = WM2200_DSP2_CONTROL_3,
0129 .selector_mask = WM2200_DSP2_PAGE_BASE_DM_0_MASK,
0130 .selector_shift = WM2200_DSP2_PAGE_BASE_DM_0_SHIFT,
0131 .window_start = WM2200_DSP2_DM_0, .window_len = 2048, },
0132
0133 { .name = "DSP2PM", .range_min = WM2200_DSP2_PM_BASE,
0134 .range_max = WM2200_DSP2_PM_BASE + 11287,
0135 .selector_reg = WM2200_DSP2_CONTROL_2,
0136 .selector_mask = WM2200_DSP2_PAGE_BASE_PM_0_MASK,
0137 .selector_shift = WM2200_DSP2_PAGE_BASE_PM_0_SHIFT,
0138 .window_start = WM2200_DSP2_PM_0, .window_len = 768, },
0139
0140 { .name = "DSP2ZM", .range_min = WM2200_DSP2_ZM_BASE,
0141 .range_max = WM2200_DSP2_ZM_BASE + 2047,
0142 .selector_reg = WM2200_DSP2_CONTROL_4,
0143 .selector_mask = WM2200_DSP2_PAGE_BASE_ZM_0_MASK,
0144 .selector_shift = WM2200_DSP2_PAGE_BASE_ZM_0_SHIFT,
0145 .window_start = WM2200_DSP2_ZM_0, .window_len = 1024, },
0146 };
0147
0148 static const struct cs_dsp_region wm2200_dsp1_regions[] = {
0149 { .type = WMFW_ADSP1_PM, .base = WM2200_DSP1_PM_BASE },
0150 { .type = WMFW_ADSP1_DM, .base = WM2200_DSP1_DM_BASE },
0151 { .type = WMFW_ADSP1_ZM, .base = WM2200_DSP1_ZM_BASE },
0152 };
0153
0154 static const struct cs_dsp_region wm2200_dsp2_regions[] = {
0155 { .type = WMFW_ADSP1_PM, .base = WM2200_DSP2_PM_BASE },
0156 { .type = WMFW_ADSP1_DM, .base = WM2200_DSP2_DM_BASE },
0157 { .type = WMFW_ADSP1_ZM, .base = WM2200_DSP2_ZM_BASE },
0158 };
0159
0160 static const struct reg_default wm2200_reg_defaults[] = {
0161 { 0x000B, 0x0000 },
0162 { 0x0102, 0x0000 },
0163 { 0x0103, 0x0011 },
0164 { 0x0111, 0x0000 },
0165 { 0x0112, 0x0000 },
0166 { 0x0113, 0x0000 },
0167 { 0x0114, 0x0000 },
0168 { 0x0116, 0x0177 },
0169 { 0x0117, 0x0004 },
0170 { 0x0119, 0x0000 },
0171 { 0x011A, 0x0002 },
0172 { 0x0200, 0x0000 },
0173 { 0x0201, 0x03FF },
0174 { 0x0202, 0x9BDE },
0175 { 0x020C, 0x0000 },
0176 { 0x020D, 0x0000 },
0177 { 0x020F, 0x0000 },
0178 { 0x0210, 0x0000 },
0179 { 0x0301, 0x0000 },
0180 { 0x0302, 0x2240 },
0181 { 0x0303, 0x0040 },
0182 { 0x0304, 0x2240 },
0183 { 0x0305, 0x0040 },
0184 { 0x0306, 0x2240 },
0185 { 0x0307, 0x0040 },
0186 { 0x030A, 0x0000 },
0187 { 0x030B, 0x0022 },
0188 { 0x030C, 0x0180 },
0189 { 0x030D, 0x0180 },
0190 { 0x030E, 0x0180 },
0191 { 0x030F, 0x0180 },
0192 { 0x0310, 0x0180 },
0193 { 0x0311, 0x0180 },
0194 { 0x0400, 0x0000 },
0195 { 0x0401, 0x0000 },
0196 { 0x0402, 0x0000 },
0197 { 0x0403, 0x0000 },
0198 { 0x0404, 0x0000 },
0199 { 0x0409, 0x0000 },
0200 { 0x040A, 0x0022 },
0201 { 0x040B, 0x0180 },
0202 { 0x040C, 0x0180 },
0203 { 0x040D, 0x0180 },
0204 { 0x040E, 0x0180 },
0205 { 0x0417, 0x0069 },
0206 { 0x0418, 0x0000 },
0207 { 0x0500, 0x0000 },
0208 { 0x0501, 0x0008 },
0209 { 0x0502, 0x0000 },
0210 { 0x0503, 0x0000 },
0211 { 0x0504, 0x0000 },
0212 { 0x0505, 0x0001 },
0213 { 0x0506, 0x0001 },
0214 { 0x0507, 0x0000 },
0215 { 0x0508, 0x0000 },
0216 { 0x0509, 0x0000 },
0217 { 0x050A, 0x0000 },
0218 { 0x050B, 0x0000 },
0219 { 0x050C, 0x0000 },
0220 { 0x050D, 0x0000 },
0221 { 0x050E, 0x0000 },
0222 { 0x050F, 0x0000 },
0223 { 0x0510, 0x0000 },
0224 { 0x0511, 0x0000 },
0225 { 0x0512, 0x0000 },
0226 { 0x0513, 0x0000 },
0227 { 0x0514, 0x0000 },
0228 { 0x0515, 0x0001 },
0229 { 0x0600, 0x0000 },
0230 { 0x0601, 0x0080 },
0231 { 0x0602, 0x0000 },
0232 { 0x0603, 0x0080 },
0233 { 0x0604, 0x0000 },
0234 { 0x0605, 0x0080 },
0235 { 0x0606, 0x0000 },
0236 { 0x0607, 0x0080 },
0237 { 0x0608, 0x0000 },
0238 { 0x0609, 0x0080 },
0239 { 0x060A, 0x0000 },
0240 { 0x060B, 0x0080 },
0241 { 0x060C, 0x0000 },
0242 { 0x060D, 0x0080 },
0243 { 0x060E, 0x0000 },
0244 { 0x060F, 0x0080 },
0245 { 0x0610, 0x0000 },
0246 { 0x0611, 0x0080 },
0247 { 0x0612, 0x0000 },
0248 { 0x0613, 0x0080 },
0249 { 0x0614, 0x0000 },
0250 { 0x0615, 0x0080 },
0251 { 0x0616, 0x0000 },
0252 { 0x0617, 0x0080 },
0253 { 0x0618, 0x0000 },
0254 { 0x0619, 0x0080 },
0255 { 0x061A, 0x0000 },
0256 { 0x061B, 0x0080 },
0257 { 0x061C, 0x0000 },
0258 { 0x061D, 0x0080 },
0259 { 0x061E, 0x0000 },
0260 { 0x061F, 0x0080 },
0261 { 0x0620, 0x0000 },
0262 { 0x0621, 0x0080 },
0263 { 0x0622, 0x0000 },
0264 { 0x0623, 0x0080 },
0265 { 0x0624, 0x0000 },
0266 { 0x0625, 0x0080 },
0267 { 0x0626, 0x0000 },
0268 { 0x0627, 0x0080 },
0269 { 0x0628, 0x0000 },
0270 { 0x0629, 0x0080 },
0271 { 0x062A, 0x0000 },
0272 { 0x062B, 0x0080 },
0273 { 0x062C, 0x0000 },
0274 { 0x062D, 0x0080 },
0275 { 0x062E, 0x0000 },
0276 { 0x062F, 0x0080 },
0277 { 0x0630, 0x0000 },
0278 { 0x0631, 0x0080 },
0279 { 0x0632, 0x0000 },
0280 { 0x0633, 0x0080 },
0281 { 0x0634, 0x0000 },
0282 { 0x0635, 0x0080 },
0283 { 0x0636, 0x0000 },
0284 { 0x0637, 0x0080 },
0285 { 0x0638, 0x0000 },
0286 { 0x0639, 0x0080 },
0287 { 0x063A, 0x0000 },
0288 { 0x063B, 0x0080 },
0289 { 0x063C, 0x0000 },
0290 { 0x063D, 0x0080 },
0291 { 0x063E, 0x0000 },
0292 { 0x063F, 0x0080 },
0293 { 0x0640, 0x0000 },
0294 { 0x0641, 0x0080 },
0295 { 0x0642, 0x0000 },
0296 { 0x0643, 0x0080 },
0297 { 0x0644, 0x0000 },
0298 { 0x0645, 0x0080 },
0299 { 0x0646, 0x0000 },
0300 { 0x0647, 0x0080 },
0301 { 0x0648, 0x0000 },
0302 { 0x0649, 0x0080 },
0303 { 0x064A, 0x0000 },
0304 { 0x064B, 0x0080 },
0305 { 0x064C, 0x0000 },
0306 { 0x064D, 0x0080 },
0307 { 0x064E, 0x0000 },
0308 { 0x064F, 0x0080 },
0309 { 0x0650, 0x0000 },
0310 { 0x0651, 0x0080 },
0311 { 0x0652, 0x0000 },
0312 { 0x0653, 0x0080 },
0313 { 0x0654, 0x0000 },
0314 { 0x0655, 0x0080 },
0315 { 0x0656, 0x0000 },
0316 { 0x0657, 0x0080 },
0317 { 0x0658, 0x0000 },
0318 { 0x0659, 0x0080 },
0319 { 0x065A, 0x0000 },
0320 { 0x065B, 0x0080 },
0321 { 0x065C, 0x0000 },
0322 { 0x065D, 0x0080 },
0323 { 0x065E, 0x0000 },
0324 { 0x065F, 0x0080 },
0325 { 0x0660, 0x0000 },
0326 { 0x0661, 0x0080 },
0327 { 0x0662, 0x0000 },
0328 { 0x0663, 0x0080 },
0329 { 0x0664, 0x0000 },
0330 { 0x0665, 0x0080 },
0331 { 0x0666, 0x0000 },
0332 { 0x0667, 0x0080 },
0333 { 0x0668, 0x0000 },
0334 { 0x0669, 0x0080 },
0335 { 0x066A, 0x0000 },
0336 { 0x066B, 0x0080 },
0337 { 0x066C, 0x0000 },
0338 { 0x066D, 0x0080 },
0339 { 0x066E, 0x0000 },
0340 { 0x066F, 0x0080 },
0341 { 0x0670, 0x0000 },
0342 { 0x0671, 0x0080 },
0343 { 0x0672, 0x0000 },
0344 { 0x0673, 0x0080 },
0345 { 0x0674, 0x0000 },
0346 { 0x0675, 0x0080 },
0347 { 0x0676, 0x0000 },
0348 { 0x0677, 0x0080 },
0349 { 0x0678, 0x0000 },
0350 { 0x0679, 0x0080 },
0351 { 0x067A, 0x0000 },
0352 { 0x067B, 0x0080 },
0353 { 0x067C, 0x0000 },
0354 { 0x067D, 0x0080 },
0355 { 0x067E, 0x0000 },
0356 { 0x067F, 0x0080 },
0357 { 0x0680, 0x0000 },
0358 { 0x0681, 0x0000 },
0359 { 0x0682, 0x0000 },
0360 { 0x0683, 0x0000 },
0361 { 0x0684, 0x0000 },
0362 { 0x0685, 0x0000 },
0363 { 0x0686, 0x0000 },
0364 { 0x0687, 0x0080 },
0365 { 0x0688, 0x0000 },
0366 { 0x0689, 0x0080 },
0367 { 0x068A, 0x0000 },
0368 { 0x068B, 0x0080 },
0369 { 0x068C, 0x0000 },
0370 { 0x068D, 0x0080 },
0371 { 0x068E, 0x0000 },
0372 { 0x068F, 0x0080 },
0373 { 0x0690, 0x0000 },
0374 { 0x0691, 0x0080 },
0375 { 0x0692, 0x0000 },
0376 { 0x0693, 0x0080 },
0377 { 0x0694, 0x0000 },
0378 { 0x0695, 0x0080 },
0379 { 0x0696, 0x0000 },
0380 { 0x0697, 0x0000 },
0381 { 0x0698, 0x0000 },
0382 { 0x0699, 0x0000 },
0383 { 0x069A, 0x0000 },
0384 { 0x069B, 0x0000 },
0385 { 0x0700, 0xA101 },
0386 { 0x0701, 0xA101 },
0387 { 0x0702, 0xA101 },
0388 { 0x0703, 0xA101 },
0389 { 0x0709, 0x0000 },
0390 { 0x0801, 0x00FF },
0391 { 0x0804, 0xFFFF },
0392 { 0x0808, 0x0000 },
0393 { 0x0900, 0x0000 },
0394 { 0x0901, 0x0000 },
0395 { 0x0902, 0x0000 },
0396 { 0x0903, 0x0000 },
0397 { 0x0904, 0x0000 },
0398 { 0x0905, 0x0000 },
0399 { 0x0906, 0x0000 },
0400 { 0x0907, 0x0000 },
0401 { 0x0908, 0x0000 },
0402 { 0x0909, 0x0000 },
0403 { 0x090A, 0x0000 },
0404 { 0x090B, 0x0000 },
0405 { 0x090C, 0x0000 },
0406 { 0x090D, 0x0000 },
0407 { 0x090E, 0x0000 },
0408 { 0x090F, 0x0000 },
0409 { 0x0910, 0x0000 },
0410 { 0x0911, 0x0000 },
0411 { 0x0912, 0x0000 },
0412 { 0x0913, 0x0000 },
0413 { 0x0916, 0x0000 },
0414 { 0x0917, 0x0000 },
0415 { 0x0918, 0x0000 },
0416 { 0x0919, 0x0000 },
0417 { 0x091A, 0x0000 },
0418 { 0x091B, 0x0000 },
0419 { 0x091C, 0x0000 },
0420 { 0x091D, 0x0000 },
0421 { 0x091E, 0x0000 },
0422 { 0x091F, 0x0000 },
0423 { 0x0920, 0x0000 },
0424 { 0x0921, 0x0000 },
0425 { 0x0922, 0x0000 },
0426 { 0x0923, 0x0000 },
0427 { 0x0924, 0x0000 },
0428 { 0x0925, 0x0000 },
0429 { 0x0926, 0x0000 },
0430 { 0x0927, 0x0000 },
0431 { 0x0928, 0x0000 },
0432 { 0x0929, 0x0000 },
0433 { 0x093E, 0x0000 },
0434 { 0x093F, 0x0000 },
0435 { 0x0942, 0x0000 },
0436 { 0x0943, 0x0000 },
0437 { 0x0A00, 0x0000 },
0438 { 0x0A02, 0x0000 },
0439 { 0x0A03, 0x0000 },
0440 { 0x0A04, 0x0000 },
0441 { 0x0A06, 0x0000 },
0442 { 0x0A07, 0x0000 },
0443 { 0x0A08, 0x0000 },
0444 { 0x0A09, 0x0000 },
0445 { 0x0A0A, 0x0000 },
0446 { 0x0A0B, 0x0000 },
0447 { 0x0A0C, 0x0000 },
0448 { 0x0A0D, 0x0000 },
0449 { 0x0A0F, 0x0000 },
0450 { 0x0A10, 0x0000 },
0451 { 0x0A11, 0x0000 },
0452 { 0x0A12, 0x0000 },
0453 { 0x0A13, 0x0000 },
0454 { 0x0A14, 0x0000 },
0455 { 0x0A16, 0x0000 },
0456 { 0x0A17, 0x0000 },
0457 { 0x0A18, 0x0000 },
0458 { 0x0A1A, 0x1800 },
0459 { 0x0A1B, 0x1000 },
0460 { 0x0A1C, 0x0400 },
0461 { 0x0A1E, 0x0000 },
0462 { 0x0A20, 0x0000 },
0463 { 0x0A21, 0x0000 },
0464 { 0x0A22, 0x0000 },
0465 { 0x0A23, 0x0000 },
0466 { 0x0A24, 0x0000 },
0467 { 0x0A26, 0x0000 },
0468 { 0x0B00, 0x0000 },
0469 { 0x0B02, 0x0000 },
0470 { 0x0B03, 0x0000 },
0471 { 0x0B04, 0x0000 },
0472 { 0x0B06, 0x0000 },
0473 { 0x0B07, 0x0000 },
0474 { 0x0B08, 0x0000 },
0475 { 0x0B09, 0x0000 },
0476 { 0x0B0A, 0x0000 },
0477 { 0x0B0B, 0x0000 },
0478 { 0x0B0C, 0x0000 },
0479 { 0x0B0D, 0x0000 },
0480 { 0x0B0F, 0x0000 },
0481 { 0x0B10, 0x0000 },
0482 { 0x0B11, 0x0000 },
0483 { 0x0B12, 0x0000 },
0484 { 0x0B13, 0x0000 },
0485 { 0x0B14, 0x0000 },
0486 { 0x0B16, 0x0000 },
0487 { 0x0B17, 0x0000 },
0488 { 0x0B18, 0x0000 },
0489 { 0x0B1A, 0x0800 },
0490 { 0x0B1B, 0x1000 },
0491 { 0x0B1C, 0x0400 },
0492 { 0x0B1E, 0x0000 },
0493 { 0x0B20, 0x0000 },
0494 { 0x0B21, 0x0000 },
0495 { 0x0B22, 0x0000 },
0496 { 0x0B23, 0x0000 },
0497 { 0x0B24, 0x0000 },
0498 { 0x0B26, 0x0000 },
0499 };
0500
0501 static bool wm2200_volatile_register(struct device *dev, unsigned int reg)
0502 {
0503 int i;
0504
0505 for (i = 0; i < ARRAY_SIZE(wm2200_ranges); i++)
0506 if ((reg >= wm2200_ranges[i].window_start &&
0507 reg <= wm2200_ranges[i].window_start +
0508 wm2200_ranges[i].window_len) ||
0509 (reg >= wm2200_ranges[i].range_min &&
0510 reg <= wm2200_ranges[i].range_max))
0511 return true;
0512
0513 switch (reg) {
0514 case WM2200_SOFTWARE_RESET:
0515 case WM2200_DEVICE_REVISION:
0516 case WM2200_ADPS1_IRQ0:
0517 case WM2200_ADPS1_IRQ1:
0518 case WM2200_INTERRUPT_STATUS_1:
0519 case WM2200_INTERRUPT_STATUS_2:
0520 case WM2200_INTERRUPT_RAW_STATUS_2:
0521 return true;
0522 default:
0523 return false;
0524 }
0525 }
0526
0527 static bool wm2200_readable_register(struct device *dev, unsigned int reg)
0528 {
0529 int i;
0530
0531 for (i = 0; i < ARRAY_SIZE(wm2200_ranges); i++)
0532 if ((reg >= wm2200_ranges[i].window_start &&
0533 reg <= wm2200_ranges[i].window_start +
0534 wm2200_ranges[i].window_len) ||
0535 (reg >= wm2200_ranges[i].range_min &&
0536 reg <= wm2200_ranges[i].range_max))
0537 return true;
0538
0539 switch (reg) {
0540 case WM2200_SOFTWARE_RESET:
0541 case WM2200_DEVICE_REVISION:
0542 case WM2200_TONE_GENERATOR_1:
0543 case WM2200_CLOCKING_3:
0544 case WM2200_CLOCKING_4:
0545 case WM2200_FLL_CONTROL_1:
0546 case WM2200_FLL_CONTROL_2:
0547 case WM2200_FLL_CONTROL_3:
0548 case WM2200_FLL_CONTROL_4:
0549 case WM2200_FLL_CONTROL_6:
0550 case WM2200_FLL_CONTROL_7:
0551 case WM2200_FLL_EFS_1:
0552 case WM2200_FLL_EFS_2:
0553 case WM2200_MIC_CHARGE_PUMP_1:
0554 case WM2200_MIC_CHARGE_PUMP_2:
0555 case WM2200_DM_CHARGE_PUMP_1:
0556 case WM2200_MIC_BIAS_CTRL_1:
0557 case WM2200_MIC_BIAS_CTRL_2:
0558 case WM2200_EAR_PIECE_CTRL_1:
0559 case WM2200_EAR_PIECE_CTRL_2:
0560 case WM2200_INPUT_ENABLES:
0561 case WM2200_IN1L_CONTROL:
0562 case WM2200_IN1R_CONTROL:
0563 case WM2200_IN2L_CONTROL:
0564 case WM2200_IN2R_CONTROL:
0565 case WM2200_IN3L_CONTROL:
0566 case WM2200_IN3R_CONTROL:
0567 case WM2200_RXANC_SRC:
0568 case WM2200_INPUT_VOLUME_RAMP:
0569 case WM2200_ADC_DIGITAL_VOLUME_1L:
0570 case WM2200_ADC_DIGITAL_VOLUME_1R:
0571 case WM2200_ADC_DIGITAL_VOLUME_2L:
0572 case WM2200_ADC_DIGITAL_VOLUME_2R:
0573 case WM2200_ADC_DIGITAL_VOLUME_3L:
0574 case WM2200_ADC_DIGITAL_VOLUME_3R:
0575 case WM2200_OUTPUT_ENABLES:
0576 case WM2200_DAC_VOLUME_LIMIT_1L:
0577 case WM2200_DAC_VOLUME_LIMIT_1R:
0578 case WM2200_DAC_VOLUME_LIMIT_2L:
0579 case WM2200_DAC_VOLUME_LIMIT_2R:
0580 case WM2200_DAC_AEC_CONTROL_1:
0581 case WM2200_OUTPUT_VOLUME_RAMP:
0582 case WM2200_DAC_DIGITAL_VOLUME_1L:
0583 case WM2200_DAC_DIGITAL_VOLUME_1R:
0584 case WM2200_DAC_DIGITAL_VOLUME_2L:
0585 case WM2200_DAC_DIGITAL_VOLUME_2R:
0586 case WM2200_PDM_1:
0587 case WM2200_PDM_2:
0588 case WM2200_AUDIO_IF_1_1:
0589 case WM2200_AUDIO_IF_1_2:
0590 case WM2200_AUDIO_IF_1_3:
0591 case WM2200_AUDIO_IF_1_4:
0592 case WM2200_AUDIO_IF_1_5:
0593 case WM2200_AUDIO_IF_1_6:
0594 case WM2200_AUDIO_IF_1_7:
0595 case WM2200_AUDIO_IF_1_8:
0596 case WM2200_AUDIO_IF_1_9:
0597 case WM2200_AUDIO_IF_1_10:
0598 case WM2200_AUDIO_IF_1_11:
0599 case WM2200_AUDIO_IF_1_12:
0600 case WM2200_AUDIO_IF_1_13:
0601 case WM2200_AUDIO_IF_1_14:
0602 case WM2200_AUDIO_IF_1_15:
0603 case WM2200_AUDIO_IF_1_16:
0604 case WM2200_AUDIO_IF_1_17:
0605 case WM2200_AUDIO_IF_1_18:
0606 case WM2200_AUDIO_IF_1_19:
0607 case WM2200_AUDIO_IF_1_20:
0608 case WM2200_AUDIO_IF_1_21:
0609 case WM2200_AUDIO_IF_1_22:
0610 case WM2200_OUT1LMIX_INPUT_1_SOURCE:
0611 case WM2200_OUT1LMIX_INPUT_1_VOLUME:
0612 case WM2200_OUT1LMIX_INPUT_2_SOURCE:
0613 case WM2200_OUT1LMIX_INPUT_2_VOLUME:
0614 case WM2200_OUT1LMIX_INPUT_3_SOURCE:
0615 case WM2200_OUT1LMIX_INPUT_3_VOLUME:
0616 case WM2200_OUT1LMIX_INPUT_4_SOURCE:
0617 case WM2200_OUT1LMIX_INPUT_4_VOLUME:
0618 case WM2200_OUT1RMIX_INPUT_1_SOURCE:
0619 case WM2200_OUT1RMIX_INPUT_1_VOLUME:
0620 case WM2200_OUT1RMIX_INPUT_2_SOURCE:
0621 case WM2200_OUT1RMIX_INPUT_2_VOLUME:
0622 case WM2200_OUT1RMIX_INPUT_3_SOURCE:
0623 case WM2200_OUT1RMIX_INPUT_3_VOLUME:
0624 case WM2200_OUT1RMIX_INPUT_4_SOURCE:
0625 case WM2200_OUT1RMIX_INPUT_4_VOLUME:
0626 case WM2200_OUT2LMIX_INPUT_1_SOURCE:
0627 case WM2200_OUT2LMIX_INPUT_1_VOLUME:
0628 case WM2200_OUT2LMIX_INPUT_2_SOURCE:
0629 case WM2200_OUT2LMIX_INPUT_2_VOLUME:
0630 case WM2200_OUT2LMIX_INPUT_3_SOURCE:
0631 case WM2200_OUT2LMIX_INPUT_3_VOLUME:
0632 case WM2200_OUT2LMIX_INPUT_4_SOURCE:
0633 case WM2200_OUT2LMIX_INPUT_4_VOLUME:
0634 case WM2200_OUT2RMIX_INPUT_1_SOURCE:
0635 case WM2200_OUT2RMIX_INPUT_1_VOLUME:
0636 case WM2200_OUT2RMIX_INPUT_2_SOURCE:
0637 case WM2200_OUT2RMIX_INPUT_2_VOLUME:
0638 case WM2200_OUT2RMIX_INPUT_3_SOURCE:
0639 case WM2200_OUT2RMIX_INPUT_3_VOLUME:
0640 case WM2200_OUT2RMIX_INPUT_4_SOURCE:
0641 case WM2200_OUT2RMIX_INPUT_4_VOLUME:
0642 case WM2200_AIF1TX1MIX_INPUT_1_SOURCE:
0643 case WM2200_AIF1TX1MIX_INPUT_1_VOLUME:
0644 case WM2200_AIF1TX1MIX_INPUT_2_SOURCE:
0645 case WM2200_AIF1TX1MIX_INPUT_2_VOLUME:
0646 case WM2200_AIF1TX1MIX_INPUT_3_SOURCE:
0647 case WM2200_AIF1TX1MIX_INPUT_3_VOLUME:
0648 case WM2200_AIF1TX1MIX_INPUT_4_SOURCE:
0649 case WM2200_AIF1TX1MIX_INPUT_4_VOLUME:
0650 case WM2200_AIF1TX2MIX_INPUT_1_SOURCE:
0651 case WM2200_AIF1TX2MIX_INPUT_1_VOLUME:
0652 case WM2200_AIF1TX2MIX_INPUT_2_SOURCE:
0653 case WM2200_AIF1TX2MIX_INPUT_2_VOLUME:
0654 case WM2200_AIF1TX2MIX_INPUT_3_SOURCE:
0655 case WM2200_AIF1TX2MIX_INPUT_3_VOLUME:
0656 case WM2200_AIF1TX2MIX_INPUT_4_SOURCE:
0657 case WM2200_AIF1TX2MIX_INPUT_4_VOLUME:
0658 case WM2200_AIF1TX3MIX_INPUT_1_SOURCE:
0659 case WM2200_AIF1TX3MIX_INPUT_1_VOLUME:
0660 case WM2200_AIF1TX3MIX_INPUT_2_SOURCE:
0661 case WM2200_AIF1TX3MIX_INPUT_2_VOLUME:
0662 case WM2200_AIF1TX3MIX_INPUT_3_SOURCE:
0663 case WM2200_AIF1TX3MIX_INPUT_3_VOLUME:
0664 case WM2200_AIF1TX3MIX_INPUT_4_SOURCE:
0665 case WM2200_AIF1TX3MIX_INPUT_4_VOLUME:
0666 case WM2200_AIF1TX4MIX_INPUT_1_SOURCE:
0667 case WM2200_AIF1TX4MIX_INPUT_1_VOLUME:
0668 case WM2200_AIF1TX4MIX_INPUT_2_SOURCE:
0669 case WM2200_AIF1TX4MIX_INPUT_2_VOLUME:
0670 case WM2200_AIF1TX4MIX_INPUT_3_SOURCE:
0671 case WM2200_AIF1TX4MIX_INPUT_3_VOLUME:
0672 case WM2200_AIF1TX4MIX_INPUT_4_SOURCE:
0673 case WM2200_AIF1TX4MIX_INPUT_4_VOLUME:
0674 case WM2200_AIF1TX5MIX_INPUT_1_SOURCE:
0675 case WM2200_AIF1TX5MIX_INPUT_1_VOLUME:
0676 case WM2200_AIF1TX5MIX_INPUT_2_SOURCE:
0677 case WM2200_AIF1TX5MIX_INPUT_2_VOLUME:
0678 case WM2200_AIF1TX5MIX_INPUT_3_SOURCE:
0679 case WM2200_AIF1TX5MIX_INPUT_3_VOLUME:
0680 case WM2200_AIF1TX5MIX_INPUT_4_SOURCE:
0681 case WM2200_AIF1TX5MIX_INPUT_4_VOLUME:
0682 case WM2200_AIF1TX6MIX_INPUT_1_SOURCE:
0683 case WM2200_AIF1TX6MIX_INPUT_1_VOLUME:
0684 case WM2200_AIF1TX6MIX_INPUT_2_SOURCE:
0685 case WM2200_AIF1TX6MIX_INPUT_2_VOLUME:
0686 case WM2200_AIF1TX6MIX_INPUT_3_SOURCE:
0687 case WM2200_AIF1TX6MIX_INPUT_3_VOLUME:
0688 case WM2200_AIF1TX6MIX_INPUT_4_SOURCE:
0689 case WM2200_AIF1TX6MIX_INPUT_4_VOLUME:
0690 case WM2200_EQLMIX_INPUT_1_SOURCE:
0691 case WM2200_EQLMIX_INPUT_1_VOLUME:
0692 case WM2200_EQLMIX_INPUT_2_SOURCE:
0693 case WM2200_EQLMIX_INPUT_2_VOLUME:
0694 case WM2200_EQLMIX_INPUT_3_SOURCE:
0695 case WM2200_EQLMIX_INPUT_3_VOLUME:
0696 case WM2200_EQLMIX_INPUT_4_SOURCE:
0697 case WM2200_EQLMIX_INPUT_4_VOLUME:
0698 case WM2200_EQRMIX_INPUT_1_SOURCE:
0699 case WM2200_EQRMIX_INPUT_1_VOLUME:
0700 case WM2200_EQRMIX_INPUT_2_SOURCE:
0701 case WM2200_EQRMIX_INPUT_2_VOLUME:
0702 case WM2200_EQRMIX_INPUT_3_SOURCE:
0703 case WM2200_EQRMIX_INPUT_3_VOLUME:
0704 case WM2200_EQRMIX_INPUT_4_SOURCE:
0705 case WM2200_EQRMIX_INPUT_4_VOLUME:
0706 case WM2200_LHPF1MIX_INPUT_1_SOURCE:
0707 case WM2200_LHPF1MIX_INPUT_1_VOLUME:
0708 case WM2200_LHPF1MIX_INPUT_2_SOURCE:
0709 case WM2200_LHPF1MIX_INPUT_2_VOLUME:
0710 case WM2200_LHPF1MIX_INPUT_3_SOURCE:
0711 case WM2200_LHPF1MIX_INPUT_3_VOLUME:
0712 case WM2200_LHPF1MIX_INPUT_4_SOURCE:
0713 case WM2200_LHPF1MIX_INPUT_4_VOLUME:
0714 case WM2200_LHPF2MIX_INPUT_1_SOURCE:
0715 case WM2200_LHPF2MIX_INPUT_1_VOLUME:
0716 case WM2200_LHPF2MIX_INPUT_2_SOURCE:
0717 case WM2200_LHPF2MIX_INPUT_2_VOLUME:
0718 case WM2200_LHPF2MIX_INPUT_3_SOURCE:
0719 case WM2200_LHPF2MIX_INPUT_3_VOLUME:
0720 case WM2200_LHPF2MIX_INPUT_4_SOURCE:
0721 case WM2200_LHPF2MIX_INPUT_4_VOLUME:
0722 case WM2200_DSP1LMIX_INPUT_1_SOURCE:
0723 case WM2200_DSP1LMIX_INPUT_1_VOLUME:
0724 case WM2200_DSP1LMIX_INPUT_2_SOURCE:
0725 case WM2200_DSP1LMIX_INPUT_2_VOLUME:
0726 case WM2200_DSP1LMIX_INPUT_3_SOURCE:
0727 case WM2200_DSP1LMIX_INPUT_3_VOLUME:
0728 case WM2200_DSP1LMIX_INPUT_4_SOURCE:
0729 case WM2200_DSP1LMIX_INPUT_4_VOLUME:
0730 case WM2200_DSP1RMIX_INPUT_1_SOURCE:
0731 case WM2200_DSP1RMIX_INPUT_1_VOLUME:
0732 case WM2200_DSP1RMIX_INPUT_2_SOURCE:
0733 case WM2200_DSP1RMIX_INPUT_2_VOLUME:
0734 case WM2200_DSP1RMIX_INPUT_3_SOURCE:
0735 case WM2200_DSP1RMIX_INPUT_3_VOLUME:
0736 case WM2200_DSP1RMIX_INPUT_4_SOURCE:
0737 case WM2200_DSP1RMIX_INPUT_4_VOLUME:
0738 case WM2200_DSP1AUX1MIX_INPUT_1_SOURCE:
0739 case WM2200_DSP1AUX2MIX_INPUT_1_SOURCE:
0740 case WM2200_DSP1AUX3MIX_INPUT_1_SOURCE:
0741 case WM2200_DSP1AUX4MIX_INPUT_1_SOURCE:
0742 case WM2200_DSP1AUX5MIX_INPUT_1_SOURCE:
0743 case WM2200_DSP1AUX6MIX_INPUT_1_SOURCE:
0744 case WM2200_DSP2LMIX_INPUT_1_SOURCE:
0745 case WM2200_DSP2LMIX_INPUT_1_VOLUME:
0746 case WM2200_DSP2LMIX_INPUT_2_SOURCE:
0747 case WM2200_DSP2LMIX_INPUT_2_VOLUME:
0748 case WM2200_DSP2LMIX_INPUT_3_SOURCE:
0749 case WM2200_DSP2LMIX_INPUT_3_VOLUME:
0750 case WM2200_DSP2LMIX_INPUT_4_SOURCE:
0751 case WM2200_DSP2LMIX_INPUT_4_VOLUME:
0752 case WM2200_DSP2RMIX_INPUT_1_SOURCE:
0753 case WM2200_DSP2RMIX_INPUT_1_VOLUME:
0754 case WM2200_DSP2RMIX_INPUT_2_SOURCE:
0755 case WM2200_DSP2RMIX_INPUT_2_VOLUME:
0756 case WM2200_DSP2RMIX_INPUT_3_SOURCE:
0757 case WM2200_DSP2RMIX_INPUT_3_VOLUME:
0758 case WM2200_DSP2RMIX_INPUT_4_SOURCE:
0759 case WM2200_DSP2RMIX_INPUT_4_VOLUME:
0760 case WM2200_DSP2AUX1MIX_INPUT_1_SOURCE:
0761 case WM2200_DSP2AUX2MIX_INPUT_1_SOURCE:
0762 case WM2200_DSP2AUX3MIX_INPUT_1_SOURCE:
0763 case WM2200_DSP2AUX4MIX_INPUT_1_SOURCE:
0764 case WM2200_DSP2AUX5MIX_INPUT_1_SOURCE:
0765 case WM2200_DSP2AUX6MIX_INPUT_1_SOURCE:
0766 case WM2200_GPIO_CTRL_1:
0767 case WM2200_GPIO_CTRL_2:
0768 case WM2200_GPIO_CTRL_3:
0769 case WM2200_GPIO_CTRL_4:
0770 case WM2200_ADPS1_IRQ0:
0771 case WM2200_ADPS1_IRQ1:
0772 case WM2200_MISC_PAD_CTRL_1:
0773 case WM2200_INTERRUPT_STATUS_1:
0774 case WM2200_INTERRUPT_STATUS_1_MASK:
0775 case WM2200_INTERRUPT_STATUS_2:
0776 case WM2200_INTERRUPT_RAW_STATUS_2:
0777 case WM2200_INTERRUPT_STATUS_2_MASK:
0778 case WM2200_INTERRUPT_CONTROL:
0779 case WM2200_EQL_1:
0780 case WM2200_EQL_2:
0781 case WM2200_EQL_3:
0782 case WM2200_EQL_4:
0783 case WM2200_EQL_5:
0784 case WM2200_EQL_6:
0785 case WM2200_EQL_7:
0786 case WM2200_EQL_8:
0787 case WM2200_EQL_9:
0788 case WM2200_EQL_10:
0789 case WM2200_EQL_11:
0790 case WM2200_EQL_12:
0791 case WM2200_EQL_13:
0792 case WM2200_EQL_14:
0793 case WM2200_EQL_15:
0794 case WM2200_EQL_16:
0795 case WM2200_EQL_17:
0796 case WM2200_EQL_18:
0797 case WM2200_EQL_19:
0798 case WM2200_EQL_20:
0799 case WM2200_EQR_1:
0800 case WM2200_EQR_2:
0801 case WM2200_EQR_3:
0802 case WM2200_EQR_4:
0803 case WM2200_EQR_5:
0804 case WM2200_EQR_6:
0805 case WM2200_EQR_7:
0806 case WM2200_EQR_8:
0807 case WM2200_EQR_9:
0808 case WM2200_EQR_10:
0809 case WM2200_EQR_11:
0810 case WM2200_EQR_12:
0811 case WM2200_EQR_13:
0812 case WM2200_EQR_14:
0813 case WM2200_EQR_15:
0814 case WM2200_EQR_16:
0815 case WM2200_EQR_17:
0816 case WM2200_EQR_18:
0817 case WM2200_EQR_19:
0818 case WM2200_EQR_20:
0819 case WM2200_HPLPF1_1:
0820 case WM2200_HPLPF1_2:
0821 case WM2200_HPLPF2_1:
0822 case WM2200_HPLPF2_2:
0823 case WM2200_DSP1_CONTROL_1:
0824 case WM2200_DSP1_CONTROL_2:
0825 case WM2200_DSP1_CONTROL_3:
0826 case WM2200_DSP1_CONTROL_4:
0827 case WM2200_DSP1_CONTROL_5:
0828 case WM2200_DSP1_CONTROL_6:
0829 case WM2200_DSP1_CONTROL_7:
0830 case WM2200_DSP1_CONTROL_8:
0831 case WM2200_DSP1_CONTROL_9:
0832 case WM2200_DSP1_CONTROL_10:
0833 case WM2200_DSP1_CONTROL_11:
0834 case WM2200_DSP1_CONTROL_12:
0835 case WM2200_DSP1_CONTROL_13:
0836 case WM2200_DSP1_CONTROL_14:
0837 case WM2200_DSP1_CONTROL_15:
0838 case WM2200_DSP1_CONTROL_16:
0839 case WM2200_DSP1_CONTROL_17:
0840 case WM2200_DSP1_CONTROL_18:
0841 case WM2200_DSP1_CONTROL_19:
0842 case WM2200_DSP1_CONTROL_20:
0843 case WM2200_DSP1_CONTROL_21:
0844 case WM2200_DSP1_CONTROL_22:
0845 case WM2200_DSP1_CONTROL_23:
0846 case WM2200_DSP1_CONTROL_24:
0847 case WM2200_DSP1_CONTROL_25:
0848 case WM2200_DSP1_CONTROL_26:
0849 case WM2200_DSP1_CONTROL_27:
0850 case WM2200_DSP1_CONTROL_28:
0851 case WM2200_DSP1_CONTROL_29:
0852 case WM2200_DSP1_CONTROL_30:
0853 case WM2200_DSP1_CONTROL_31:
0854 case WM2200_DSP2_CONTROL_1:
0855 case WM2200_DSP2_CONTROL_2:
0856 case WM2200_DSP2_CONTROL_3:
0857 case WM2200_DSP2_CONTROL_4:
0858 case WM2200_DSP2_CONTROL_5:
0859 case WM2200_DSP2_CONTROL_6:
0860 case WM2200_DSP2_CONTROL_7:
0861 case WM2200_DSP2_CONTROL_8:
0862 case WM2200_DSP2_CONTROL_9:
0863 case WM2200_DSP2_CONTROL_10:
0864 case WM2200_DSP2_CONTROL_11:
0865 case WM2200_DSP2_CONTROL_12:
0866 case WM2200_DSP2_CONTROL_13:
0867 case WM2200_DSP2_CONTROL_14:
0868 case WM2200_DSP2_CONTROL_15:
0869 case WM2200_DSP2_CONTROL_16:
0870 case WM2200_DSP2_CONTROL_17:
0871 case WM2200_DSP2_CONTROL_18:
0872 case WM2200_DSP2_CONTROL_19:
0873 case WM2200_DSP2_CONTROL_20:
0874 case WM2200_DSP2_CONTROL_21:
0875 case WM2200_DSP2_CONTROL_22:
0876 case WM2200_DSP2_CONTROL_23:
0877 case WM2200_DSP2_CONTROL_24:
0878 case WM2200_DSP2_CONTROL_25:
0879 case WM2200_DSP2_CONTROL_26:
0880 case WM2200_DSP2_CONTROL_27:
0881 case WM2200_DSP2_CONTROL_28:
0882 case WM2200_DSP2_CONTROL_29:
0883 case WM2200_DSP2_CONTROL_30:
0884 case WM2200_DSP2_CONTROL_31:
0885 return true;
0886 default:
0887 return false;
0888 }
0889 }
0890
0891 static const struct reg_sequence wm2200_reva_patch[] = {
0892 { 0x07, 0x0003 },
0893 { 0x102, 0x0200 },
0894 { 0x203, 0x0084 },
0895 { 0x201, 0x83FF },
0896 { 0x20C, 0x0062 },
0897 { 0x20D, 0x0062 },
0898 { 0x207, 0x2002 },
0899 { 0x208, 0x20C0 },
0900 { 0x21D, 0x01C0 },
0901 { 0x50A, 0x0001 },
0902 { 0x50B, 0x0002 },
0903 { 0x50C, 0x0003 },
0904 { 0x50D, 0x0004 },
0905 { 0x50E, 0x0005 },
0906 { 0x510, 0x0001 },
0907 { 0x511, 0x0002 },
0908 { 0x512, 0x0003 },
0909 { 0x513, 0x0004 },
0910 { 0x514, 0x0005 },
0911 { 0x515, 0x0000 },
0912 { 0x201, 0x8084 },
0913 { 0x202, 0xBBDE },
0914 { 0x203, 0x00EC },
0915 { 0x500, 0x8000 },
0916 { 0x507, 0x1820 },
0917 { 0x508, 0x1820 },
0918 { 0x505, 0x0300 },
0919 { 0x506, 0x0300 },
0920 { 0x302, 0x2280 },
0921 { 0x303, 0x0080 },
0922 { 0x304, 0x2280 },
0923 { 0x305, 0x0080 },
0924 { 0x306, 0x2280 },
0925 { 0x307, 0x0080 },
0926 { 0x401, 0x0080 },
0927 { 0x402, 0x0080 },
0928 { 0x417, 0x3069 },
0929 { 0x900, 0x6318 },
0930 { 0x901, 0x6300 },
0931 { 0x902, 0x0FC8 },
0932 { 0x903, 0x03FE },
0933 { 0x904, 0x00E0 },
0934 { 0x905, 0x1EC4 },
0935 { 0x906, 0xF136 },
0936 { 0x907, 0x0409 },
0937 { 0x908, 0x04CC },
0938 { 0x909, 0x1C9B },
0939 { 0x90A, 0xF337 },
0940 { 0x90B, 0x040B },
0941 { 0x90C, 0x0CBB },
0942 { 0x90D, 0x16F8 },
0943 { 0x90E, 0xF7D9 },
0944 { 0x90F, 0x040A },
0945 { 0x910, 0x1F14 },
0946 { 0x911, 0x058C },
0947 { 0x912, 0x0563 },
0948 { 0x913, 0x4000 },
0949 { 0x916, 0x6318 },
0950 { 0x917, 0x6300 },
0951 { 0x918, 0x0FC8 },
0952 { 0x919, 0x03FE },
0953 { 0x91A, 0x00E0 },
0954 { 0x91B, 0x1EC4 },
0955 { 0x91C, 0xF136 },
0956 { 0x91D, 0x0409 },
0957 { 0x91E, 0x04CC },
0958 { 0x91F, 0x1C9B },
0959 { 0x920, 0xF337 },
0960 { 0x921, 0x040B },
0961 { 0x922, 0x0CBB },
0962 { 0x923, 0x16F8 },
0963 { 0x924, 0xF7D9 },
0964 { 0x925, 0x040A },
0965 { 0x926, 0x1F14 },
0966 { 0x927, 0x058C },
0967 { 0x928, 0x0563 },
0968 { 0x929, 0x4000 },
0969 { 0x709, 0x2000 },
0970 { 0x207, 0x200E },
0971 { 0x208, 0x20D4 },
0972 { 0x20A, 0x0080 },
0973 { 0x07, 0x0000 },
0974 };
0975
0976 static int wm2200_reset(struct wm2200_priv *wm2200)
0977 {
0978 if (wm2200->pdata.reset) {
0979 gpio_set_value_cansleep(wm2200->pdata.reset, 0);
0980 gpio_set_value_cansleep(wm2200->pdata.reset, 1);
0981
0982 return 0;
0983 } else {
0984 return regmap_write(wm2200->regmap, WM2200_SOFTWARE_RESET,
0985 0x2200);
0986 }
0987 }
0988
0989 static DECLARE_TLV_DB_SCALE(in_tlv, -6300, 100, 0);
0990 static DECLARE_TLV_DB_SCALE(digital_tlv, -6400, 50, 0);
0991 static DECLARE_TLV_DB_SCALE(out_tlv, -6400, 100, 0);
0992
0993 static const char * const wm2200_mixer_texts[] = {
0994 "None",
0995 "Tone Generator",
0996 "AEC Loopback",
0997 "IN1L",
0998 "IN1R",
0999 "IN2L",
1000 "IN2R",
1001 "IN3L",
1002 "IN3R",
1003 "AIF1RX1",
1004 "AIF1RX2",
1005 "AIF1RX3",
1006 "AIF1RX4",
1007 "AIF1RX5",
1008 "AIF1RX6",
1009 "EQL",
1010 "EQR",
1011 "LHPF1",
1012 "LHPF2",
1013 "DSP1.1",
1014 "DSP1.2",
1015 "DSP1.3",
1016 "DSP1.4",
1017 "DSP1.5",
1018 "DSP1.6",
1019 "DSP2.1",
1020 "DSP2.2",
1021 "DSP2.3",
1022 "DSP2.4",
1023 "DSP2.5",
1024 "DSP2.6",
1025 };
1026
1027 static unsigned int wm2200_mixer_values[] = {
1028 0x00,
1029 0x04,
1030 0x08,
1031 0x10,
1032 0x11,
1033 0x12,
1034 0x13,
1035 0x14,
1036 0x15,
1037 0x20,
1038 0x21,
1039 0x22,
1040 0x23,
1041 0x24,
1042 0x25,
1043 0x50,
1044 0x51,
1045 0x60,
1046 0x61,
1047 0x68,
1048 0x69,
1049 0x6a,
1050 0x6b,
1051 0x6c,
1052 0x6d,
1053 0x70,
1054 0x71,
1055 0x72,
1056 0x73,
1057 0x74,
1058 0x75,
1059 };
1060
1061 #define WM2200_MIXER_CONTROLS(name, base) \
1062 SOC_SINGLE_TLV(name " Input 1 Volume", base + 1 , \
1063 WM2200_MIXER_VOL_SHIFT, 80, 0, mixer_tlv), \
1064 SOC_SINGLE_TLV(name " Input 2 Volume", base + 3 , \
1065 WM2200_MIXER_VOL_SHIFT, 80, 0, mixer_tlv), \
1066 SOC_SINGLE_TLV(name " Input 3 Volume", base + 5 , \
1067 WM2200_MIXER_VOL_SHIFT, 80, 0, mixer_tlv), \
1068 SOC_SINGLE_TLV(name " Input 4 Volume", base + 7 , \
1069 WM2200_MIXER_VOL_SHIFT, 80, 0, mixer_tlv)
1070
1071 #define WM2200_MUX_ENUM_DECL(name, reg) \
1072 SOC_VALUE_ENUM_SINGLE_DECL(name, reg, 0, 0xff, \
1073 wm2200_mixer_texts, wm2200_mixer_values)
1074
1075 #define WM2200_MUX_CTL_DECL(name) \
1076 const struct snd_kcontrol_new name##_mux = \
1077 SOC_DAPM_ENUM("Route", name##_enum)
1078
1079 #define WM2200_MIXER_ENUMS(name, base_reg) \
1080 static WM2200_MUX_ENUM_DECL(name##_in1_enum, base_reg); \
1081 static WM2200_MUX_ENUM_DECL(name##_in2_enum, base_reg + 2); \
1082 static WM2200_MUX_ENUM_DECL(name##_in3_enum, base_reg + 4); \
1083 static WM2200_MUX_ENUM_DECL(name##_in4_enum, base_reg + 6); \
1084 static WM2200_MUX_CTL_DECL(name##_in1); \
1085 static WM2200_MUX_CTL_DECL(name##_in2); \
1086 static WM2200_MUX_CTL_DECL(name##_in3); \
1087 static WM2200_MUX_CTL_DECL(name##_in4)
1088
1089 #define WM2200_DSP_ENUMS(name, base_reg) \
1090 static WM2200_MUX_ENUM_DECL(name##_aux1_enum, base_reg); \
1091 static WM2200_MUX_ENUM_DECL(name##_aux2_enum, base_reg + 1); \
1092 static WM2200_MUX_ENUM_DECL(name##_aux3_enum, base_reg + 2); \
1093 static WM2200_MUX_ENUM_DECL(name##_aux4_enum, base_reg + 3); \
1094 static WM2200_MUX_ENUM_DECL(name##_aux5_enum, base_reg + 4); \
1095 static WM2200_MUX_ENUM_DECL(name##_aux6_enum, base_reg + 5); \
1096 static WM2200_MUX_CTL_DECL(name##_aux1); \
1097 static WM2200_MUX_CTL_DECL(name##_aux2); \
1098 static WM2200_MUX_CTL_DECL(name##_aux3); \
1099 static WM2200_MUX_CTL_DECL(name##_aux4); \
1100 static WM2200_MUX_CTL_DECL(name##_aux5); \
1101 static WM2200_MUX_CTL_DECL(name##_aux6);
1102
1103 static const char *wm2200_rxanc_input_sel_texts[] = {
1104 "None", "IN1", "IN2", "IN3",
1105 };
1106
1107 static SOC_ENUM_SINGLE_DECL(wm2200_rxanc_input_sel,
1108 WM2200_RXANC_SRC,
1109 WM2200_IN_RXANC_SEL_SHIFT,
1110 wm2200_rxanc_input_sel_texts);
1111
1112 static const struct snd_kcontrol_new wm2200_snd_controls[] = {
1113 SOC_SINGLE("IN1 High Performance Switch", WM2200_IN1L_CONTROL,
1114 WM2200_IN1_OSR_SHIFT, 1, 0),
1115 SOC_SINGLE("IN2 High Performance Switch", WM2200_IN2L_CONTROL,
1116 WM2200_IN2_OSR_SHIFT, 1, 0),
1117 SOC_SINGLE("IN3 High Performance Switch", WM2200_IN3L_CONTROL,
1118 WM2200_IN3_OSR_SHIFT, 1, 0),
1119
1120 SOC_DOUBLE_R_TLV("IN1 Volume", WM2200_IN1L_CONTROL, WM2200_IN1R_CONTROL,
1121 WM2200_IN1L_PGA_VOL_SHIFT, 0x5f, 0, in_tlv),
1122 SOC_DOUBLE_R_TLV("IN2 Volume", WM2200_IN2L_CONTROL, WM2200_IN2R_CONTROL,
1123 WM2200_IN2L_PGA_VOL_SHIFT, 0x5f, 0, in_tlv),
1124 SOC_DOUBLE_R_TLV("IN3 Volume", WM2200_IN3L_CONTROL, WM2200_IN3R_CONTROL,
1125 WM2200_IN3L_PGA_VOL_SHIFT, 0x5f, 0, in_tlv),
1126
1127 SOC_DOUBLE_R("IN1 Digital Switch", WM2200_ADC_DIGITAL_VOLUME_1L,
1128 WM2200_ADC_DIGITAL_VOLUME_1R, WM2200_IN1L_MUTE_SHIFT, 1, 1),
1129 SOC_DOUBLE_R("IN2 Digital Switch", WM2200_ADC_DIGITAL_VOLUME_2L,
1130 WM2200_ADC_DIGITAL_VOLUME_2R, WM2200_IN2L_MUTE_SHIFT, 1, 1),
1131 SOC_DOUBLE_R("IN3 Digital Switch", WM2200_ADC_DIGITAL_VOLUME_3L,
1132 WM2200_ADC_DIGITAL_VOLUME_3R, WM2200_IN3L_MUTE_SHIFT, 1, 1),
1133
1134 SOC_DOUBLE_R_TLV("IN1 Digital Volume", WM2200_ADC_DIGITAL_VOLUME_1L,
1135 WM2200_ADC_DIGITAL_VOLUME_1R, WM2200_IN1L_DIG_VOL_SHIFT,
1136 0xbf, 0, digital_tlv),
1137 SOC_DOUBLE_R_TLV("IN2 Digital Volume", WM2200_ADC_DIGITAL_VOLUME_2L,
1138 WM2200_ADC_DIGITAL_VOLUME_2R, WM2200_IN2L_DIG_VOL_SHIFT,
1139 0xbf, 0, digital_tlv),
1140 SOC_DOUBLE_R_TLV("IN3 Digital Volume", WM2200_ADC_DIGITAL_VOLUME_3L,
1141 WM2200_ADC_DIGITAL_VOLUME_3R, WM2200_IN3L_DIG_VOL_SHIFT,
1142 0xbf, 0, digital_tlv),
1143
1144 SND_SOC_BYTES_MASK("EQL Coefficients", WM2200_EQL_1, 20, WM2200_EQL_ENA),
1145 SND_SOC_BYTES_MASK("EQR Coefficients", WM2200_EQR_1, 20, WM2200_EQR_ENA),
1146
1147 SND_SOC_BYTES("LHPF1 Coefficients", WM2200_HPLPF1_2, 1),
1148 SND_SOC_BYTES("LHPF2 Coefficients", WM2200_HPLPF2_2, 1),
1149
1150 SOC_SINGLE("OUT1 High Performance Switch", WM2200_DAC_DIGITAL_VOLUME_1L,
1151 WM2200_OUT1_OSR_SHIFT, 1, 0),
1152 SOC_SINGLE("OUT2 High Performance Switch", WM2200_DAC_DIGITAL_VOLUME_2L,
1153 WM2200_OUT2_OSR_SHIFT, 1, 0),
1154
1155 SOC_DOUBLE_R("OUT1 Digital Switch", WM2200_DAC_DIGITAL_VOLUME_1L,
1156 WM2200_DAC_DIGITAL_VOLUME_1R, WM2200_OUT1L_MUTE_SHIFT, 1, 1),
1157 SOC_DOUBLE_R_TLV("OUT1 Digital Volume", WM2200_DAC_DIGITAL_VOLUME_1L,
1158 WM2200_DAC_DIGITAL_VOLUME_1R, WM2200_OUT1L_VOL_SHIFT, 0x9f, 0,
1159 digital_tlv),
1160 SOC_DOUBLE_R_TLV("OUT1 Volume", WM2200_DAC_VOLUME_LIMIT_1L,
1161 WM2200_DAC_VOLUME_LIMIT_1R, WM2200_OUT1L_PGA_VOL_SHIFT,
1162 0x46, 0, out_tlv),
1163
1164 SOC_DOUBLE_R("OUT2 Digital Switch", WM2200_DAC_DIGITAL_VOLUME_2L,
1165 WM2200_DAC_DIGITAL_VOLUME_2R, WM2200_OUT2L_MUTE_SHIFT, 1, 1),
1166 SOC_DOUBLE_R_TLV("OUT2 Digital Volume", WM2200_DAC_DIGITAL_VOLUME_2L,
1167 WM2200_DAC_DIGITAL_VOLUME_2R, WM2200_OUT2L_VOL_SHIFT, 0x9f, 0,
1168 digital_tlv),
1169 SOC_DOUBLE("OUT2 Switch", WM2200_PDM_1, WM2200_SPK1L_MUTE_SHIFT,
1170 WM2200_SPK1R_MUTE_SHIFT, 1, 1),
1171 SOC_ENUM("RxANC Src", wm2200_rxanc_input_sel),
1172
1173 WM_ADSP_FW_CONTROL("DSP1", 0),
1174 WM_ADSP_FW_CONTROL("DSP2", 1),
1175 };
1176
1177 WM2200_MIXER_ENUMS(OUT1L, WM2200_OUT1LMIX_INPUT_1_SOURCE);
1178 WM2200_MIXER_ENUMS(OUT1R, WM2200_OUT1RMIX_INPUT_1_SOURCE);
1179 WM2200_MIXER_ENUMS(OUT2L, WM2200_OUT2LMIX_INPUT_1_SOURCE);
1180 WM2200_MIXER_ENUMS(OUT2R, WM2200_OUT2RMIX_INPUT_1_SOURCE);
1181
1182 WM2200_MIXER_ENUMS(AIF1TX1, WM2200_AIF1TX1MIX_INPUT_1_SOURCE);
1183 WM2200_MIXER_ENUMS(AIF1TX2, WM2200_AIF1TX2MIX_INPUT_1_SOURCE);
1184 WM2200_MIXER_ENUMS(AIF1TX3, WM2200_AIF1TX3MIX_INPUT_1_SOURCE);
1185 WM2200_MIXER_ENUMS(AIF1TX4, WM2200_AIF1TX4MIX_INPUT_1_SOURCE);
1186 WM2200_MIXER_ENUMS(AIF1TX5, WM2200_AIF1TX5MIX_INPUT_1_SOURCE);
1187 WM2200_MIXER_ENUMS(AIF1TX6, WM2200_AIF1TX6MIX_INPUT_1_SOURCE);
1188
1189 WM2200_MIXER_ENUMS(EQL, WM2200_EQLMIX_INPUT_1_SOURCE);
1190 WM2200_MIXER_ENUMS(EQR, WM2200_EQRMIX_INPUT_1_SOURCE);
1191
1192 WM2200_MIXER_ENUMS(DSP1L, WM2200_DSP1LMIX_INPUT_1_SOURCE);
1193 WM2200_MIXER_ENUMS(DSP1R, WM2200_DSP1RMIX_INPUT_1_SOURCE);
1194 WM2200_MIXER_ENUMS(DSP2L, WM2200_DSP2LMIX_INPUT_1_SOURCE);
1195 WM2200_MIXER_ENUMS(DSP2R, WM2200_DSP2RMIX_INPUT_1_SOURCE);
1196
1197 WM2200_DSP_ENUMS(DSP1, WM2200_DSP1AUX1MIX_INPUT_1_SOURCE);
1198 WM2200_DSP_ENUMS(DSP2, WM2200_DSP2AUX1MIX_INPUT_1_SOURCE);
1199
1200 WM2200_MIXER_ENUMS(LHPF1, WM2200_LHPF1MIX_INPUT_1_SOURCE);
1201 WM2200_MIXER_ENUMS(LHPF2, WM2200_LHPF2MIX_INPUT_1_SOURCE);
1202
1203 #define WM2200_MUX(name, ctrl) \
1204 SND_SOC_DAPM_MUX(name, SND_SOC_NOPM, 0, 0, ctrl)
1205
1206 #define WM2200_MIXER_WIDGETS(name, name_str) \
1207 WM2200_MUX(name_str " Input 1", &name##_in1_mux), \
1208 WM2200_MUX(name_str " Input 2", &name##_in2_mux), \
1209 WM2200_MUX(name_str " Input 3", &name##_in3_mux), \
1210 WM2200_MUX(name_str " Input 4", &name##_in4_mux), \
1211 SND_SOC_DAPM_MIXER(name_str " Mixer", SND_SOC_NOPM, 0, 0, NULL, 0)
1212
1213 #define WM2200_DSP_WIDGETS(name, name_str) \
1214 WM2200_MIXER_WIDGETS(name##L, name_str "L"), \
1215 WM2200_MIXER_WIDGETS(name##R, name_str "R"), \
1216 WM2200_MUX(name_str " Aux 1", &name##_aux1_mux), \
1217 WM2200_MUX(name_str " Aux 2", &name##_aux2_mux), \
1218 WM2200_MUX(name_str " Aux 3", &name##_aux3_mux), \
1219 WM2200_MUX(name_str " Aux 4", &name##_aux4_mux), \
1220 WM2200_MUX(name_str " Aux 5", &name##_aux5_mux), \
1221 WM2200_MUX(name_str " Aux 6", &name##_aux6_mux)
1222
1223 #define WM2200_MIXER_INPUT_ROUTES(name) \
1224 { name, "Tone Generator", "Tone Generator" }, \
1225 { name, "AEC Loopback", "AEC Loopback" }, \
1226 { name, "IN1L", "IN1L PGA" }, \
1227 { name, "IN1R", "IN1R PGA" }, \
1228 { name, "IN2L", "IN2L PGA" }, \
1229 { name, "IN2R", "IN2R PGA" }, \
1230 { name, "IN3L", "IN3L PGA" }, \
1231 { name, "IN3R", "IN3R PGA" }, \
1232 { name, "DSP1.1", "DSP1" }, \
1233 { name, "DSP1.2", "DSP1" }, \
1234 { name, "DSP1.3", "DSP1" }, \
1235 { name, "DSP1.4", "DSP1" }, \
1236 { name, "DSP1.5", "DSP1" }, \
1237 { name, "DSP1.6", "DSP1" }, \
1238 { name, "DSP2.1", "DSP2" }, \
1239 { name, "DSP2.2", "DSP2" }, \
1240 { name, "DSP2.3", "DSP2" }, \
1241 { name, "DSP2.4", "DSP2" }, \
1242 { name, "DSP2.5", "DSP2" }, \
1243 { name, "DSP2.6", "DSP2" }, \
1244 { name, "AIF1RX1", "AIF1RX1" }, \
1245 { name, "AIF1RX2", "AIF1RX2" }, \
1246 { name, "AIF1RX3", "AIF1RX3" }, \
1247 { name, "AIF1RX4", "AIF1RX4" }, \
1248 { name, "AIF1RX5", "AIF1RX5" }, \
1249 { name, "AIF1RX6", "AIF1RX6" }, \
1250 { name, "EQL", "EQL" }, \
1251 { name, "EQR", "EQR" }, \
1252 { name, "LHPF1", "LHPF1" }, \
1253 { name, "LHPF2", "LHPF2" }
1254
1255 #define WM2200_MIXER_ROUTES(widget, name) \
1256 { widget, NULL, name " Mixer" }, \
1257 { name " Mixer", NULL, name " Input 1" }, \
1258 { name " Mixer", NULL, name " Input 2" }, \
1259 { name " Mixer", NULL, name " Input 3" }, \
1260 { name " Mixer", NULL, name " Input 4" }, \
1261 WM2200_MIXER_INPUT_ROUTES(name " Input 1"), \
1262 WM2200_MIXER_INPUT_ROUTES(name " Input 2"), \
1263 WM2200_MIXER_INPUT_ROUTES(name " Input 3"), \
1264 WM2200_MIXER_INPUT_ROUTES(name " Input 4")
1265
1266 #define WM2200_DSP_AUX_ROUTES(name) \
1267 { name, NULL, name " Aux 1" }, \
1268 { name, NULL, name " Aux 2" }, \
1269 { name, NULL, name " Aux 3" }, \
1270 { name, NULL, name " Aux 4" }, \
1271 { name, NULL, name " Aux 5" }, \
1272 { name, NULL, name " Aux 6" }, \
1273 WM2200_MIXER_INPUT_ROUTES(name " Aux 1"), \
1274 WM2200_MIXER_INPUT_ROUTES(name " Aux 2"), \
1275 WM2200_MIXER_INPUT_ROUTES(name " Aux 3"), \
1276 WM2200_MIXER_INPUT_ROUTES(name " Aux 4"), \
1277 WM2200_MIXER_INPUT_ROUTES(name " Aux 5"), \
1278 WM2200_MIXER_INPUT_ROUTES(name " Aux 6")
1279
1280 static const char *wm2200_aec_loopback_texts[] = {
1281 "OUT1L", "OUT1R", "OUT2L", "OUT2R",
1282 };
1283
1284 static SOC_ENUM_SINGLE_DECL(wm2200_aec_loopback,
1285 WM2200_DAC_AEC_CONTROL_1,
1286 WM2200_AEC_LOOPBACK_SRC_SHIFT,
1287 wm2200_aec_loopback_texts);
1288
1289 static const struct snd_kcontrol_new wm2200_aec_loopback_mux =
1290 SOC_DAPM_ENUM("AEC Loopback", wm2200_aec_loopback);
1291
1292 static const struct snd_soc_dapm_widget wm2200_dapm_widgets[] = {
1293 SND_SOC_DAPM_SUPPLY("SYSCLK", WM2200_CLOCKING_3, WM2200_SYSCLK_ENA_SHIFT, 0,
1294 NULL, 0),
1295 SND_SOC_DAPM_SUPPLY("CP1", WM2200_DM_CHARGE_PUMP_1, WM2200_CPDM_ENA_SHIFT, 0,
1296 NULL, 0),
1297 SND_SOC_DAPM_SUPPLY("CP2", WM2200_MIC_CHARGE_PUMP_1, WM2200_CPMIC_ENA_SHIFT, 0,
1298 NULL, 0),
1299 SND_SOC_DAPM_SUPPLY("MICBIAS1", WM2200_MIC_BIAS_CTRL_1, WM2200_MICB1_ENA_SHIFT,
1300 0, NULL, 0),
1301 SND_SOC_DAPM_SUPPLY("MICBIAS2", WM2200_MIC_BIAS_CTRL_2, WM2200_MICB2_ENA_SHIFT,
1302 0, NULL, 0),
1303 SND_SOC_DAPM_REGULATOR_SUPPLY("CPVDD", 20, 0),
1304 SND_SOC_DAPM_REGULATOR_SUPPLY("AVDD", 20, 0),
1305
1306 SND_SOC_DAPM_INPUT("IN1L"),
1307 SND_SOC_DAPM_INPUT("IN1R"),
1308 SND_SOC_DAPM_INPUT("IN2L"),
1309 SND_SOC_DAPM_INPUT("IN2R"),
1310 SND_SOC_DAPM_INPUT("IN3L"),
1311 SND_SOC_DAPM_INPUT("IN3R"),
1312
1313 SND_SOC_DAPM_SIGGEN("TONE"),
1314 SND_SOC_DAPM_PGA("Tone Generator", WM2200_TONE_GENERATOR_1,
1315 WM2200_TONE_ENA_SHIFT, 0, NULL, 0),
1316
1317 SND_SOC_DAPM_PGA("IN1L PGA", WM2200_INPUT_ENABLES, WM2200_IN1L_ENA_SHIFT, 0,
1318 NULL, 0),
1319 SND_SOC_DAPM_PGA("IN1R PGA", WM2200_INPUT_ENABLES, WM2200_IN1R_ENA_SHIFT, 0,
1320 NULL, 0),
1321 SND_SOC_DAPM_PGA("IN2L PGA", WM2200_INPUT_ENABLES, WM2200_IN2L_ENA_SHIFT, 0,
1322 NULL, 0),
1323 SND_SOC_DAPM_PGA("IN2R PGA", WM2200_INPUT_ENABLES, WM2200_IN2R_ENA_SHIFT, 0,
1324 NULL, 0),
1325 SND_SOC_DAPM_PGA("IN3L PGA", WM2200_INPUT_ENABLES, WM2200_IN3L_ENA_SHIFT, 0,
1326 NULL, 0),
1327 SND_SOC_DAPM_PGA("IN3R PGA", WM2200_INPUT_ENABLES, WM2200_IN3R_ENA_SHIFT, 0,
1328 NULL, 0),
1329
1330 SND_SOC_DAPM_AIF_IN("AIF1RX1", "Playback", 0,
1331 WM2200_AUDIO_IF_1_22, WM2200_AIF1RX1_ENA_SHIFT, 0),
1332 SND_SOC_DAPM_AIF_IN("AIF1RX2", "Playback", 1,
1333 WM2200_AUDIO_IF_1_22, WM2200_AIF1RX2_ENA_SHIFT, 0),
1334 SND_SOC_DAPM_AIF_IN("AIF1RX3", "Playback", 2,
1335 WM2200_AUDIO_IF_1_22, WM2200_AIF1RX3_ENA_SHIFT, 0),
1336 SND_SOC_DAPM_AIF_IN("AIF1RX4", "Playback", 3,
1337 WM2200_AUDIO_IF_1_22, WM2200_AIF1RX4_ENA_SHIFT, 0),
1338 SND_SOC_DAPM_AIF_IN("AIF1RX5", "Playback", 4,
1339 WM2200_AUDIO_IF_1_22, WM2200_AIF1RX5_ENA_SHIFT, 0),
1340 SND_SOC_DAPM_AIF_IN("AIF1RX6", "Playback", 5,
1341 WM2200_AUDIO_IF_1_22, WM2200_AIF1RX6_ENA_SHIFT, 0),
1342
1343 SND_SOC_DAPM_PGA("EQL", WM2200_EQL_1, WM2200_EQL_ENA_SHIFT, 0, NULL, 0),
1344 SND_SOC_DAPM_PGA("EQR", WM2200_EQR_1, WM2200_EQR_ENA_SHIFT, 0, NULL, 0),
1345
1346 SND_SOC_DAPM_PGA("LHPF1", WM2200_HPLPF1_1, WM2200_LHPF1_ENA_SHIFT, 0,
1347 NULL, 0),
1348 SND_SOC_DAPM_PGA("LHPF2", WM2200_HPLPF2_1, WM2200_LHPF2_ENA_SHIFT, 0,
1349 NULL, 0),
1350
1351 WM_ADSP1("DSP1", 0),
1352 WM_ADSP1("DSP2", 1),
1353
1354 SND_SOC_DAPM_AIF_OUT("AIF1TX1", "Capture", 0,
1355 WM2200_AUDIO_IF_1_22, WM2200_AIF1TX1_ENA_SHIFT, 0),
1356 SND_SOC_DAPM_AIF_OUT("AIF1TX2", "Capture", 1,
1357 WM2200_AUDIO_IF_1_22, WM2200_AIF1TX2_ENA_SHIFT, 0),
1358 SND_SOC_DAPM_AIF_OUT("AIF1TX3", "Capture", 2,
1359 WM2200_AUDIO_IF_1_22, WM2200_AIF1TX3_ENA_SHIFT, 0),
1360 SND_SOC_DAPM_AIF_OUT("AIF1TX4", "Capture", 3,
1361 WM2200_AUDIO_IF_1_22, WM2200_AIF1TX4_ENA_SHIFT, 0),
1362 SND_SOC_DAPM_AIF_OUT("AIF1TX5", "Capture", 4,
1363 WM2200_AUDIO_IF_1_22, WM2200_AIF1TX5_ENA_SHIFT, 0),
1364 SND_SOC_DAPM_AIF_OUT("AIF1TX6", "Capture", 5,
1365 WM2200_AUDIO_IF_1_22, WM2200_AIF1TX6_ENA_SHIFT, 0),
1366
1367 SND_SOC_DAPM_MUX("AEC Loopback", WM2200_DAC_AEC_CONTROL_1,
1368 WM2200_AEC_LOOPBACK_ENA_SHIFT, 0, &wm2200_aec_loopback_mux),
1369
1370 SND_SOC_DAPM_PGA_S("OUT1L", 0, WM2200_OUTPUT_ENABLES,
1371 WM2200_OUT1L_ENA_SHIFT, 0, NULL, 0),
1372 SND_SOC_DAPM_PGA_S("OUT1R", 0, WM2200_OUTPUT_ENABLES,
1373 WM2200_OUT1R_ENA_SHIFT, 0, NULL, 0),
1374
1375 SND_SOC_DAPM_PGA_S("EPD_LP", 1, WM2200_EAR_PIECE_CTRL_1,
1376 WM2200_EPD_LP_ENA_SHIFT, 0, NULL, 0),
1377 SND_SOC_DAPM_PGA_S("EPD_OUTP_LP", 1, WM2200_EAR_PIECE_CTRL_1,
1378 WM2200_EPD_OUTP_LP_ENA_SHIFT, 0, NULL, 0),
1379 SND_SOC_DAPM_PGA_S("EPD_RMV_SHRT_LP", 1, WM2200_EAR_PIECE_CTRL_1,
1380 WM2200_EPD_RMV_SHRT_LP_SHIFT, 0, NULL, 0),
1381
1382 SND_SOC_DAPM_PGA_S("EPD_LN", 1, WM2200_EAR_PIECE_CTRL_1,
1383 WM2200_EPD_LN_ENA_SHIFT, 0, NULL, 0),
1384 SND_SOC_DAPM_PGA_S("EPD_OUTP_LN", 1, WM2200_EAR_PIECE_CTRL_1,
1385 WM2200_EPD_OUTP_LN_ENA_SHIFT, 0, NULL, 0),
1386 SND_SOC_DAPM_PGA_S("EPD_RMV_SHRT_LN", 1, WM2200_EAR_PIECE_CTRL_1,
1387 WM2200_EPD_RMV_SHRT_LN_SHIFT, 0, NULL, 0),
1388
1389 SND_SOC_DAPM_PGA_S("EPD_RP", 1, WM2200_EAR_PIECE_CTRL_2,
1390 WM2200_EPD_RP_ENA_SHIFT, 0, NULL, 0),
1391 SND_SOC_DAPM_PGA_S("EPD_OUTP_RP", 1, WM2200_EAR_PIECE_CTRL_2,
1392 WM2200_EPD_OUTP_RP_ENA_SHIFT, 0, NULL, 0),
1393 SND_SOC_DAPM_PGA_S("EPD_RMV_SHRT_RP", 1, WM2200_EAR_PIECE_CTRL_2,
1394 WM2200_EPD_RMV_SHRT_RP_SHIFT, 0, NULL, 0),
1395
1396 SND_SOC_DAPM_PGA_S("EPD_RN", 1, WM2200_EAR_PIECE_CTRL_2,
1397 WM2200_EPD_RN_ENA_SHIFT, 0, NULL, 0),
1398 SND_SOC_DAPM_PGA_S("EPD_OUTP_RN", 1, WM2200_EAR_PIECE_CTRL_2,
1399 WM2200_EPD_OUTP_RN_ENA_SHIFT, 0, NULL, 0),
1400 SND_SOC_DAPM_PGA_S("EPD_RMV_SHRT_RN", 1, WM2200_EAR_PIECE_CTRL_2,
1401 WM2200_EPD_RMV_SHRT_RN_SHIFT, 0, NULL, 0),
1402
1403 SND_SOC_DAPM_PGA("OUT2L", WM2200_OUTPUT_ENABLES, WM2200_OUT2L_ENA_SHIFT,
1404 0, NULL, 0),
1405 SND_SOC_DAPM_PGA("OUT2R", WM2200_OUTPUT_ENABLES, WM2200_OUT2R_ENA_SHIFT,
1406 0, NULL, 0),
1407
1408 SND_SOC_DAPM_OUTPUT("EPOUTLN"),
1409 SND_SOC_DAPM_OUTPUT("EPOUTLP"),
1410 SND_SOC_DAPM_OUTPUT("EPOUTRN"),
1411 SND_SOC_DAPM_OUTPUT("EPOUTRP"),
1412 SND_SOC_DAPM_OUTPUT("SPK"),
1413
1414 WM2200_MIXER_WIDGETS(EQL, "EQL"),
1415 WM2200_MIXER_WIDGETS(EQR, "EQR"),
1416
1417 WM2200_MIXER_WIDGETS(LHPF1, "LHPF1"),
1418 WM2200_MIXER_WIDGETS(LHPF2, "LHPF2"),
1419
1420 WM2200_DSP_WIDGETS(DSP1, "DSP1"),
1421 WM2200_DSP_WIDGETS(DSP2, "DSP2"),
1422
1423 WM2200_MIXER_WIDGETS(AIF1TX1, "AIF1TX1"),
1424 WM2200_MIXER_WIDGETS(AIF1TX2, "AIF1TX2"),
1425 WM2200_MIXER_WIDGETS(AIF1TX3, "AIF1TX3"),
1426 WM2200_MIXER_WIDGETS(AIF1TX4, "AIF1TX4"),
1427 WM2200_MIXER_WIDGETS(AIF1TX5, "AIF1TX5"),
1428 WM2200_MIXER_WIDGETS(AIF1TX6, "AIF1TX6"),
1429
1430 WM2200_MIXER_WIDGETS(OUT1L, "OUT1L"),
1431 WM2200_MIXER_WIDGETS(OUT1R, "OUT1R"),
1432 WM2200_MIXER_WIDGETS(OUT2L, "OUT2L"),
1433 WM2200_MIXER_WIDGETS(OUT2R, "OUT2R"),
1434 };
1435
1436 static const struct snd_soc_dapm_route wm2200_dapm_routes[] = {
1437
1438
1439 { "IN1L", NULL, "SYSCLK" },
1440 { "IN1R", NULL, "SYSCLK" },
1441 { "IN2L", NULL, "SYSCLK" },
1442 { "IN2R", NULL, "SYSCLK" },
1443 { "IN3L", NULL, "SYSCLK" },
1444 { "IN3R", NULL, "SYSCLK" },
1445 { "OUT1L", NULL, "SYSCLK" },
1446 { "OUT1R", NULL, "SYSCLK" },
1447 { "OUT2L", NULL, "SYSCLK" },
1448 { "OUT2R", NULL, "SYSCLK" },
1449 { "AIF1RX1", NULL, "SYSCLK" },
1450 { "AIF1RX2", NULL, "SYSCLK" },
1451 { "AIF1RX3", NULL, "SYSCLK" },
1452 { "AIF1RX4", NULL, "SYSCLK" },
1453 { "AIF1RX5", NULL, "SYSCLK" },
1454 { "AIF1RX6", NULL, "SYSCLK" },
1455 { "AIF1TX1", NULL, "SYSCLK" },
1456 { "AIF1TX2", NULL, "SYSCLK" },
1457 { "AIF1TX3", NULL, "SYSCLK" },
1458 { "AIF1TX4", NULL, "SYSCLK" },
1459 { "AIF1TX5", NULL, "SYSCLK" },
1460 { "AIF1TX6", NULL, "SYSCLK" },
1461
1462 { "IN1L", NULL, "AVDD" },
1463 { "IN1R", NULL, "AVDD" },
1464 { "IN2L", NULL, "AVDD" },
1465 { "IN2R", NULL, "AVDD" },
1466 { "IN3L", NULL, "AVDD" },
1467 { "IN3R", NULL, "AVDD" },
1468 { "OUT1L", NULL, "AVDD" },
1469 { "OUT1R", NULL, "AVDD" },
1470
1471 { "IN1L PGA", NULL, "IN1L" },
1472 { "IN1R PGA", NULL, "IN1R" },
1473 { "IN2L PGA", NULL, "IN2L" },
1474 { "IN2R PGA", NULL, "IN2R" },
1475 { "IN3L PGA", NULL, "IN3L" },
1476 { "IN3R PGA", NULL, "IN3R" },
1477
1478 { "Tone Generator", NULL, "TONE" },
1479
1480 { "CP2", NULL, "CPVDD" },
1481 { "MICBIAS1", NULL, "CP2" },
1482 { "MICBIAS2", NULL, "CP2" },
1483
1484 { "CP1", NULL, "CPVDD" },
1485 { "EPD_LN", NULL, "CP1" },
1486 { "EPD_LP", NULL, "CP1" },
1487 { "EPD_RN", NULL, "CP1" },
1488 { "EPD_RP", NULL, "CP1" },
1489
1490 { "EPD_LP", NULL, "OUT1L" },
1491 { "EPD_OUTP_LP", NULL, "EPD_LP" },
1492 { "EPD_RMV_SHRT_LP", NULL, "EPD_OUTP_LP" },
1493 { "EPOUTLP", NULL, "EPD_RMV_SHRT_LP" },
1494
1495 { "EPD_LN", NULL, "OUT1L" },
1496 { "EPD_OUTP_LN", NULL, "EPD_LN" },
1497 { "EPD_RMV_SHRT_LN", NULL, "EPD_OUTP_LN" },
1498 { "EPOUTLN", NULL, "EPD_RMV_SHRT_LN" },
1499
1500 { "EPD_RP", NULL, "OUT1R" },
1501 { "EPD_OUTP_RP", NULL, "EPD_RP" },
1502 { "EPD_RMV_SHRT_RP", NULL, "EPD_OUTP_RP" },
1503 { "EPOUTRP", NULL, "EPD_RMV_SHRT_RP" },
1504
1505 { "EPD_RN", NULL, "OUT1R" },
1506 { "EPD_OUTP_RN", NULL, "EPD_RN" },
1507 { "EPD_RMV_SHRT_RN", NULL, "EPD_OUTP_RN" },
1508 { "EPOUTRN", NULL, "EPD_RMV_SHRT_RN" },
1509
1510 { "SPK", NULL, "OUT2L" },
1511 { "SPK", NULL, "OUT2R" },
1512
1513 { "AEC Loopback", "OUT1L", "OUT1L" },
1514 { "AEC Loopback", "OUT1R", "OUT1R" },
1515 { "AEC Loopback", "OUT2L", "OUT2L" },
1516 { "AEC Loopback", "OUT2R", "OUT2R" },
1517
1518 WM2200_MIXER_ROUTES("DSP1", "DSP1L"),
1519 WM2200_MIXER_ROUTES("DSP1", "DSP1R"),
1520 WM2200_MIXER_ROUTES("DSP2", "DSP2L"),
1521 WM2200_MIXER_ROUTES("DSP2", "DSP2R"),
1522
1523 WM2200_DSP_AUX_ROUTES("DSP1"),
1524 WM2200_DSP_AUX_ROUTES("DSP2"),
1525
1526 WM2200_MIXER_ROUTES("OUT1L", "OUT1L"),
1527 WM2200_MIXER_ROUTES("OUT1R", "OUT1R"),
1528 WM2200_MIXER_ROUTES("OUT2L", "OUT2L"),
1529 WM2200_MIXER_ROUTES("OUT2R", "OUT2R"),
1530
1531 WM2200_MIXER_ROUTES("AIF1TX1", "AIF1TX1"),
1532 WM2200_MIXER_ROUTES("AIF1TX2", "AIF1TX2"),
1533 WM2200_MIXER_ROUTES("AIF1TX3", "AIF1TX3"),
1534 WM2200_MIXER_ROUTES("AIF1TX4", "AIF1TX4"),
1535 WM2200_MIXER_ROUTES("AIF1TX5", "AIF1TX5"),
1536 WM2200_MIXER_ROUTES("AIF1TX6", "AIF1TX6"),
1537
1538 WM2200_MIXER_ROUTES("EQL", "EQL"),
1539 WM2200_MIXER_ROUTES("EQR", "EQR"),
1540
1541 WM2200_MIXER_ROUTES("LHPF1", "LHPF1"),
1542 WM2200_MIXER_ROUTES("LHPF2", "LHPF2"),
1543 };
1544
1545 static int wm2200_probe(struct snd_soc_component *component)
1546 {
1547 struct wm2200_priv *wm2200 = snd_soc_component_get_drvdata(component);
1548
1549 wm2200->component = component;
1550
1551 return 0;
1552 }
1553
1554 static int wm2200_set_fmt(struct snd_soc_dai *dai, unsigned int fmt)
1555 {
1556 struct snd_soc_component *component = dai->component;
1557 int lrclk, bclk, fmt_val;
1558
1559 lrclk = 0;
1560 bclk = 0;
1561
1562 switch (fmt & SND_SOC_DAIFMT_FORMAT_MASK) {
1563 case SND_SOC_DAIFMT_DSP_A:
1564 fmt_val = 0;
1565 break;
1566 case SND_SOC_DAIFMT_I2S:
1567 fmt_val = 2;
1568 break;
1569 default:
1570 dev_err(component->dev, "Unsupported DAI format %d\n",
1571 fmt & SND_SOC_DAIFMT_FORMAT_MASK);
1572 return -EINVAL;
1573 }
1574
1575 switch (fmt & SND_SOC_DAIFMT_MASTER_MASK) {
1576 case SND_SOC_DAIFMT_CBS_CFS:
1577 break;
1578 case SND_SOC_DAIFMT_CBS_CFM:
1579 lrclk |= WM2200_AIF1TX_LRCLK_MSTR;
1580 break;
1581 case SND_SOC_DAIFMT_CBM_CFS:
1582 bclk |= WM2200_AIF1_BCLK_MSTR;
1583 break;
1584 case SND_SOC_DAIFMT_CBM_CFM:
1585 lrclk |= WM2200_AIF1TX_LRCLK_MSTR;
1586 bclk |= WM2200_AIF1_BCLK_MSTR;
1587 break;
1588 default:
1589 dev_err(component->dev, "Unsupported master mode %d\n",
1590 fmt & SND_SOC_DAIFMT_MASTER_MASK);
1591 return -EINVAL;
1592 }
1593
1594 switch (fmt & SND_SOC_DAIFMT_INV_MASK) {
1595 case SND_SOC_DAIFMT_NB_NF:
1596 break;
1597 case SND_SOC_DAIFMT_IB_IF:
1598 bclk |= WM2200_AIF1_BCLK_INV;
1599 lrclk |= WM2200_AIF1TX_LRCLK_INV;
1600 break;
1601 case SND_SOC_DAIFMT_IB_NF:
1602 bclk |= WM2200_AIF1_BCLK_INV;
1603 break;
1604 case SND_SOC_DAIFMT_NB_IF:
1605 lrclk |= WM2200_AIF1TX_LRCLK_INV;
1606 break;
1607 default:
1608 return -EINVAL;
1609 }
1610
1611 snd_soc_component_update_bits(component, WM2200_AUDIO_IF_1_1, WM2200_AIF1_BCLK_MSTR |
1612 WM2200_AIF1_BCLK_INV, bclk);
1613 snd_soc_component_update_bits(component, WM2200_AUDIO_IF_1_2,
1614 WM2200_AIF1TX_LRCLK_MSTR | WM2200_AIF1TX_LRCLK_INV,
1615 lrclk);
1616 snd_soc_component_update_bits(component, WM2200_AUDIO_IF_1_3,
1617 WM2200_AIF1TX_LRCLK_MSTR | WM2200_AIF1TX_LRCLK_INV,
1618 lrclk);
1619 snd_soc_component_update_bits(component, WM2200_AUDIO_IF_1_5,
1620 WM2200_AIF1_FMT_MASK, fmt_val);
1621
1622 return 0;
1623 }
1624
1625 static int wm2200_sr_code[] = {
1626 0,
1627 12000,
1628 24000,
1629 48000,
1630 96000,
1631 192000,
1632 384000,
1633 768000,
1634 0,
1635 11025,
1636 22050,
1637 44100,
1638 88200,
1639 176400,
1640 352800,
1641 705600,
1642 4000,
1643 8000,
1644 16000,
1645 32000,
1646 64000,
1647 128000,
1648 256000,
1649 512000,
1650 };
1651
1652 #define WM2200_NUM_BCLK_RATES 12
1653
1654 static int wm2200_bclk_rates_dat[WM2200_NUM_BCLK_RATES] = {
1655 6144000,
1656 3072000,
1657 2048000,
1658 1536000,
1659 768000,
1660 512000,
1661 384000,
1662 256000,
1663 192000,
1664 128000,
1665 96000,
1666 64000,
1667 };
1668
1669 static int wm2200_bclk_rates_cd[WM2200_NUM_BCLK_RATES] = {
1670 5644800,
1671 3763200,
1672 2882400,
1673 1881600,
1674 1411200,
1675 705600,
1676 470400,
1677 352800,
1678 176400,
1679 117600,
1680 88200,
1681 58800,
1682 };
1683
1684 static int wm2200_hw_params(struct snd_pcm_substream *substream,
1685 struct snd_pcm_hw_params *params,
1686 struct snd_soc_dai *dai)
1687 {
1688 struct snd_soc_component *component = dai->component;
1689 struct wm2200_priv *wm2200 = snd_soc_component_get_drvdata(component);
1690 int i, bclk, lrclk, wl, fl, sr_code;
1691 int *bclk_rates;
1692
1693
1694 wl = params_width(params);
1695 if (wl < 0)
1696 return wl;
1697 fl = snd_soc_params_to_frame_size(params);
1698 if (fl < 0)
1699 return fl;
1700
1701 dev_dbg(component->dev, "Word length %d bits, frame length %d bits\n",
1702 wl, fl);
1703
1704
1705 bclk = snd_soc_params_to_bclk(params);
1706 if (bclk < 0)
1707 return bclk;
1708
1709 if (!wm2200->sysclk) {
1710 dev_err(component->dev, "SYSCLK has no rate set\n");
1711 return -EINVAL;
1712 }
1713
1714 for (i = 0; i < ARRAY_SIZE(wm2200_sr_code); i++)
1715 if (wm2200_sr_code[i] == params_rate(params))
1716 break;
1717 if (i == ARRAY_SIZE(wm2200_sr_code)) {
1718 dev_err(component->dev, "Unsupported sample rate: %dHz\n",
1719 params_rate(params));
1720 return -EINVAL;
1721 }
1722 sr_code = i;
1723
1724 dev_dbg(component->dev, "Target BCLK is %dHz, using %dHz SYSCLK\n",
1725 bclk, wm2200->sysclk);
1726
1727 if (wm2200->sysclk % 4000)
1728 bclk_rates = wm2200_bclk_rates_cd;
1729 else
1730 bclk_rates = wm2200_bclk_rates_dat;
1731
1732 for (i = 0; i < WM2200_NUM_BCLK_RATES; i++)
1733 if (bclk_rates[i] >= bclk && (bclk_rates[i] % bclk == 0))
1734 break;
1735 if (i == WM2200_NUM_BCLK_RATES) {
1736 dev_err(component->dev,
1737 "No valid BCLK for %dHz found from %dHz SYSCLK\n",
1738 bclk, wm2200->sysclk);
1739 return -EINVAL;
1740 }
1741
1742 bclk = i;
1743 dev_dbg(component->dev, "Setting %dHz BCLK\n", bclk_rates[bclk]);
1744 snd_soc_component_update_bits(component, WM2200_AUDIO_IF_1_1,
1745 WM2200_AIF1_BCLK_DIV_MASK, bclk);
1746
1747 lrclk = bclk_rates[bclk] / params_rate(params);
1748 dev_dbg(component->dev, "Setting %dHz LRCLK\n", bclk_rates[bclk] / lrclk);
1749 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK ||
1750 wm2200->symmetric_rates)
1751 snd_soc_component_update_bits(component, WM2200_AUDIO_IF_1_7,
1752 WM2200_AIF1RX_BCPF_MASK, lrclk);
1753 else
1754 snd_soc_component_update_bits(component, WM2200_AUDIO_IF_1_6,
1755 WM2200_AIF1TX_BCPF_MASK, lrclk);
1756
1757 i = (wl << WM2200_AIF1TX_WL_SHIFT) | wl;
1758 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
1759 snd_soc_component_update_bits(component, WM2200_AUDIO_IF_1_9,
1760 WM2200_AIF1RX_WL_MASK |
1761 WM2200_AIF1RX_SLOT_LEN_MASK, i);
1762 else
1763 snd_soc_component_update_bits(component, WM2200_AUDIO_IF_1_8,
1764 WM2200_AIF1TX_WL_MASK |
1765 WM2200_AIF1TX_SLOT_LEN_MASK, i);
1766
1767 snd_soc_component_update_bits(component, WM2200_CLOCKING_4,
1768 WM2200_SAMPLE_RATE_1_MASK, sr_code);
1769
1770 return 0;
1771 }
1772
1773 static const struct snd_soc_dai_ops wm2200_dai_ops = {
1774 .set_fmt = wm2200_set_fmt,
1775 .hw_params = wm2200_hw_params,
1776 };
1777
1778 static int wm2200_set_sysclk(struct snd_soc_component *component, int clk_id,
1779 int source, unsigned int freq, int dir)
1780 {
1781 struct wm2200_priv *wm2200 = snd_soc_component_get_drvdata(component);
1782 int fval;
1783
1784 switch (clk_id) {
1785 case WM2200_CLK_SYSCLK:
1786 break;
1787
1788 default:
1789 dev_err(component->dev, "Unknown clock %d\n", clk_id);
1790 return -EINVAL;
1791 }
1792
1793 switch (source) {
1794 case WM2200_CLKSRC_MCLK1:
1795 case WM2200_CLKSRC_MCLK2:
1796 case WM2200_CLKSRC_FLL:
1797 case WM2200_CLKSRC_BCLK1:
1798 break;
1799 default:
1800 dev_err(component->dev, "Invalid source %d\n", source);
1801 return -EINVAL;
1802 }
1803
1804 switch (freq) {
1805 case 22579200:
1806 case 24576000:
1807 fval = 2;
1808 break;
1809 default:
1810 dev_err(component->dev, "Invalid clock rate: %d\n", freq);
1811 return -EINVAL;
1812 }
1813
1814
1815
1816
1817
1818 snd_soc_component_update_bits(component, WM2200_CLOCKING_3, WM2200_SYSCLK_FREQ_MASK |
1819 WM2200_SYSCLK_SRC_MASK,
1820 fval << WM2200_SYSCLK_FREQ_SHIFT | source);
1821
1822 wm2200->sysclk = freq;
1823
1824 return 0;
1825 }
1826
1827 struct _fll_div {
1828 u16 fll_fratio;
1829 u16 fll_outdiv;
1830 u16 fll_refclk_div;
1831 u16 n;
1832 u16 theta;
1833 u16 lambda;
1834 };
1835
1836 static struct {
1837 unsigned int min;
1838 unsigned int max;
1839 u16 fll_fratio;
1840 int ratio;
1841 } fll_fratios[] = {
1842 { 0, 64000, 4, 16 },
1843 { 64000, 128000, 3, 8 },
1844 { 128000, 256000, 2, 4 },
1845 { 256000, 1000000, 1, 2 },
1846 { 1000000, 13500000, 0, 1 },
1847 };
1848
1849 static int fll_factors(struct _fll_div *fll_div, unsigned int Fref,
1850 unsigned int Fout)
1851 {
1852 unsigned int target;
1853 unsigned int div;
1854 unsigned int fratio, gcd_fll;
1855 int i;
1856
1857
1858 div = 1;
1859 fll_div->fll_refclk_div = 0;
1860 while ((Fref / div) > 13500000) {
1861 div *= 2;
1862 fll_div->fll_refclk_div++;
1863
1864 if (div > 8) {
1865 pr_err("Can't scale %dMHz input down to <=13.5MHz\n",
1866 Fref);
1867 return -EINVAL;
1868 }
1869 }
1870
1871 pr_debug("FLL Fref=%u Fout=%u\n", Fref, Fout);
1872
1873
1874 Fref /= div;
1875
1876
1877 div = 2;
1878 while (Fout * div < 90000000) {
1879 div++;
1880 if (div > 64) {
1881 pr_err("Unable to find FLL_OUTDIV for Fout=%uHz\n",
1882 Fout);
1883 return -EINVAL;
1884 }
1885 }
1886 target = Fout * div;
1887 fll_div->fll_outdiv = div - 1;
1888
1889 pr_debug("FLL Fvco=%dHz\n", target);
1890
1891
1892 for (i = 0; i < ARRAY_SIZE(fll_fratios); i++) {
1893 if (fll_fratios[i].min <= Fref && Fref <= fll_fratios[i].max) {
1894 fll_div->fll_fratio = fll_fratios[i].fll_fratio;
1895 fratio = fll_fratios[i].ratio;
1896 break;
1897 }
1898 }
1899 if (i == ARRAY_SIZE(fll_fratios)) {
1900 pr_err("Unable to find FLL_FRATIO for Fref=%uHz\n", Fref);
1901 return -EINVAL;
1902 }
1903
1904 fll_div->n = target / (fratio * Fref);
1905
1906 if (target % Fref == 0) {
1907 fll_div->theta = 0;
1908 fll_div->lambda = 0;
1909 } else {
1910 gcd_fll = gcd(target, fratio * Fref);
1911
1912 fll_div->theta = (target - (fll_div->n * fratio * Fref))
1913 / gcd_fll;
1914 fll_div->lambda = (fratio * Fref) / gcd_fll;
1915 }
1916
1917 pr_debug("FLL N=%x THETA=%x LAMBDA=%x\n",
1918 fll_div->n, fll_div->theta, fll_div->lambda);
1919 pr_debug("FLL_FRATIO=%x(%d) FLL_OUTDIV=%x FLL_REFCLK_DIV=%x\n",
1920 fll_div->fll_fratio, fratio, fll_div->fll_outdiv,
1921 fll_div->fll_refclk_div);
1922
1923 return 0;
1924 }
1925
1926 static int wm2200_set_fll(struct snd_soc_component *component, int fll_id, int source,
1927 unsigned int Fref, unsigned int Fout)
1928 {
1929 struct i2c_client *i2c = to_i2c_client(component->dev);
1930 struct wm2200_priv *wm2200 = snd_soc_component_get_drvdata(component);
1931 struct _fll_div factors;
1932 int ret, i, timeout;
1933 unsigned long time_left;
1934
1935 if (!Fout) {
1936 dev_dbg(component->dev, "FLL disabled");
1937
1938 if (wm2200->fll_fout)
1939 pm_runtime_put(component->dev);
1940
1941 wm2200->fll_fout = 0;
1942 snd_soc_component_update_bits(component, WM2200_FLL_CONTROL_1,
1943 WM2200_FLL_ENA, 0);
1944 return 0;
1945 }
1946
1947 switch (source) {
1948 case WM2200_FLL_SRC_MCLK1:
1949 case WM2200_FLL_SRC_MCLK2:
1950 case WM2200_FLL_SRC_BCLK:
1951 break;
1952 default:
1953 dev_err(component->dev, "Invalid FLL source %d\n", source);
1954 return -EINVAL;
1955 }
1956
1957 ret = fll_factors(&factors, Fref, Fout);
1958 if (ret < 0)
1959 return ret;
1960
1961
1962 snd_soc_component_update_bits(component, WM2200_FLL_CONTROL_1, WM2200_FLL_ENA, 0);
1963
1964 snd_soc_component_update_bits(component, WM2200_FLL_CONTROL_2,
1965 WM2200_FLL_OUTDIV_MASK | WM2200_FLL_FRATIO_MASK,
1966 (factors.fll_outdiv << WM2200_FLL_OUTDIV_SHIFT) |
1967 factors.fll_fratio);
1968 if (factors.theta) {
1969 snd_soc_component_update_bits(component, WM2200_FLL_CONTROL_3,
1970 WM2200_FLL_FRACN_ENA,
1971 WM2200_FLL_FRACN_ENA);
1972 snd_soc_component_update_bits(component, WM2200_FLL_EFS_2,
1973 WM2200_FLL_EFS_ENA,
1974 WM2200_FLL_EFS_ENA);
1975 } else {
1976 snd_soc_component_update_bits(component, WM2200_FLL_CONTROL_3,
1977 WM2200_FLL_FRACN_ENA, 0);
1978 snd_soc_component_update_bits(component, WM2200_FLL_EFS_2,
1979 WM2200_FLL_EFS_ENA, 0);
1980 }
1981
1982 snd_soc_component_update_bits(component, WM2200_FLL_CONTROL_4, WM2200_FLL_THETA_MASK,
1983 factors.theta);
1984 snd_soc_component_update_bits(component, WM2200_FLL_CONTROL_6, WM2200_FLL_N_MASK,
1985 factors.n);
1986 snd_soc_component_update_bits(component, WM2200_FLL_CONTROL_7,
1987 WM2200_FLL_CLK_REF_DIV_MASK |
1988 WM2200_FLL_CLK_REF_SRC_MASK,
1989 (factors.fll_refclk_div
1990 << WM2200_FLL_CLK_REF_DIV_SHIFT) | source);
1991 snd_soc_component_update_bits(component, WM2200_FLL_EFS_1,
1992 WM2200_FLL_LAMBDA_MASK, factors.lambda);
1993
1994
1995 try_wait_for_completion(&wm2200->fll_lock);
1996
1997 pm_runtime_get_sync(component->dev);
1998
1999 snd_soc_component_update_bits(component, WM2200_FLL_CONTROL_1,
2000 WM2200_FLL_ENA, WM2200_FLL_ENA);
2001
2002 if (i2c->irq)
2003 timeout = 2;
2004 else
2005 timeout = 50;
2006
2007 snd_soc_component_update_bits(component, WM2200_CLOCKING_3, WM2200_SYSCLK_ENA,
2008 WM2200_SYSCLK_ENA);
2009
2010
2011 for (i = 0; i < timeout; i++) {
2012 if (i2c->irq) {
2013 time_left = wait_for_completion_timeout(
2014 &wm2200->fll_lock,
2015 msecs_to_jiffies(25));
2016 if (time_left > 0)
2017 break;
2018 } else {
2019 msleep(1);
2020 }
2021
2022 ret = snd_soc_component_read(component,
2023 WM2200_INTERRUPT_RAW_STATUS_2);
2024 if (ret < 0) {
2025 dev_err(component->dev,
2026 "Failed to read FLL status: %d\n",
2027 ret);
2028 continue;
2029 }
2030 if (ret & WM2200_FLL_LOCK_STS)
2031 break;
2032 }
2033 if (i == timeout) {
2034 dev_err(component->dev, "FLL lock timed out\n");
2035 pm_runtime_put(component->dev);
2036 return -ETIMEDOUT;
2037 }
2038
2039 wm2200->fll_src = source;
2040 wm2200->fll_fref = Fref;
2041 wm2200->fll_fout = Fout;
2042
2043 dev_dbg(component->dev, "FLL running %dHz->%dHz\n", Fref, Fout);
2044
2045 return 0;
2046 }
2047
2048 static int wm2200_dai_probe(struct snd_soc_dai *dai)
2049 {
2050 struct snd_soc_component *component = dai->component;
2051 struct wm2200_priv *wm2200 = snd_soc_component_get_drvdata(component);
2052 unsigned int val = 0;
2053 int ret;
2054
2055 ret = snd_soc_component_read(component, WM2200_GPIO_CTRL_1);
2056 if (ret >= 0) {
2057 if ((ret & WM2200_GP1_FN_MASK) != 0) {
2058 wm2200->symmetric_rates = true;
2059 val = WM2200_AIF1TX_LRCLK_SRC;
2060 }
2061 } else {
2062 dev_err(component->dev, "Failed to read GPIO 1 config: %d\n", ret);
2063 }
2064
2065 snd_soc_component_update_bits(component, WM2200_AUDIO_IF_1_2,
2066 WM2200_AIF1TX_LRCLK_SRC, val);
2067
2068 return 0;
2069 }
2070
2071 #define WM2200_RATES SNDRV_PCM_RATE_8000_48000
2072
2073 #define WM2200_FORMATS (SNDRV_PCM_FMTBIT_S16_LE | SNDRV_PCM_FMTBIT_S20_3LE |\
2074 SNDRV_PCM_FMTBIT_S24_LE | SNDRV_PCM_FMTBIT_S32_LE)
2075
2076 static struct snd_soc_dai_driver wm2200_dai = {
2077 .name = "wm2200",
2078 .probe = wm2200_dai_probe,
2079 .playback = {
2080 .stream_name = "Playback",
2081 .channels_min = 2,
2082 .channels_max = 2,
2083 .rates = WM2200_RATES,
2084 .formats = WM2200_FORMATS,
2085 },
2086 .capture = {
2087 .stream_name = "Capture",
2088 .channels_min = 2,
2089 .channels_max = 2,
2090 .rates = WM2200_RATES,
2091 .formats = WM2200_FORMATS,
2092 },
2093 .ops = &wm2200_dai_ops,
2094 };
2095
2096 static const struct snd_soc_component_driver soc_component_wm2200 = {
2097 .probe = wm2200_probe,
2098 .set_sysclk = wm2200_set_sysclk,
2099 .set_pll = wm2200_set_fll,
2100 .controls = wm2200_snd_controls,
2101 .num_controls = ARRAY_SIZE(wm2200_snd_controls),
2102 .dapm_widgets = wm2200_dapm_widgets,
2103 .num_dapm_widgets = ARRAY_SIZE(wm2200_dapm_widgets),
2104 .dapm_routes = wm2200_dapm_routes,
2105 .num_dapm_routes = ARRAY_SIZE(wm2200_dapm_routes),
2106 .endianness = 1,
2107 };
2108
2109 static irqreturn_t wm2200_irq(int irq, void *data)
2110 {
2111 struct wm2200_priv *wm2200 = data;
2112 unsigned int val, mask;
2113 int ret;
2114
2115 ret = regmap_read(wm2200->regmap, WM2200_INTERRUPT_STATUS_2, &val);
2116 if (ret != 0) {
2117 dev_err(wm2200->dev, "Failed to read IRQ status: %d\n", ret);
2118 return IRQ_NONE;
2119 }
2120
2121 ret = regmap_read(wm2200->regmap, WM2200_INTERRUPT_STATUS_2_MASK,
2122 &mask);
2123 if (ret != 0) {
2124 dev_warn(wm2200->dev, "Failed to read IRQ mask: %d\n", ret);
2125 mask = 0;
2126 }
2127
2128 val &= ~mask;
2129
2130 if (val & WM2200_FLL_LOCK_EINT) {
2131 dev_dbg(wm2200->dev, "FLL locked\n");
2132 complete(&wm2200->fll_lock);
2133 }
2134
2135 if (val) {
2136 regmap_write(wm2200->regmap, WM2200_INTERRUPT_STATUS_2, val);
2137
2138 return IRQ_HANDLED;
2139 } else {
2140 return IRQ_NONE;
2141 }
2142 }
2143
2144 static const struct regmap_config wm2200_regmap = {
2145 .reg_bits = 16,
2146 .val_bits = 16,
2147
2148 .max_register = WM2200_MAX_REGISTER + (ARRAY_SIZE(wm2200_ranges) *
2149 WM2200_DSP_SPACING),
2150 .reg_defaults = wm2200_reg_defaults,
2151 .num_reg_defaults = ARRAY_SIZE(wm2200_reg_defaults),
2152 .volatile_reg = wm2200_volatile_register,
2153 .readable_reg = wm2200_readable_register,
2154 .cache_type = REGCACHE_RBTREE,
2155 .ranges = wm2200_ranges,
2156 .num_ranges = ARRAY_SIZE(wm2200_ranges),
2157 };
2158
2159 static const unsigned int wm2200_dig_vu[] = {
2160 WM2200_DAC_DIGITAL_VOLUME_1L,
2161 WM2200_DAC_DIGITAL_VOLUME_1R,
2162 WM2200_DAC_DIGITAL_VOLUME_2L,
2163 WM2200_DAC_DIGITAL_VOLUME_2R,
2164 WM2200_ADC_DIGITAL_VOLUME_1L,
2165 WM2200_ADC_DIGITAL_VOLUME_1R,
2166 WM2200_ADC_DIGITAL_VOLUME_2L,
2167 WM2200_ADC_DIGITAL_VOLUME_2R,
2168 WM2200_ADC_DIGITAL_VOLUME_3L,
2169 WM2200_ADC_DIGITAL_VOLUME_3R,
2170 };
2171
2172 static const unsigned int wm2200_mic_ctrl_reg[] = {
2173 WM2200_IN1L_CONTROL,
2174 WM2200_IN2L_CONTROL,
2175 WM2200_IN3L_CONTROL,
2176 };
2177
2178 static int wm2200_i2c_probe(struct i2c_client *i2c)
2179 {
2180 struct wm2200_pdata *pdata = dev_get_platdata(&i2c->dev);
2181 struct wm2200_priv *wm2200;
2182 unsigned int reg;
2183 int ret, i;
2184 int val;
2185
2186 wm2200 = devm_kzalloc(&i2c->dev, sizeof(struct wm2200_priv),
2187 GFP_KERNEL);
2188 if (wm2200 == NULL)
2189 return -ENOMEM;
2190
2191 wm2200->dev = &i2c->dev;
2192 init_completion(&wm2200->fll_lock);
2193
2194 wm2200->regmap = devm_regmap_init_i2c(i2c, &wm2200_regmap);
2195 if (IS_ERR(wm2200->regmap)) {
2196 ret = PTR_ERR(wm2200->regmap);
2197 dev_err(&i2c->dev, "Failed to allocate register map: %d\n",
2198 ret);
2199 return ret;
2200 }
2201
2202 for (i = 0; i < 2; i++) {
2203 wm2200->dsp[i].cs_dsp.type = WMFW_ADSP1;
2204 wm2200->dsp[i].part = "wm2200";
2205 wm2200->dsp[i].cs_dsp.num = i + 1;
2206 wm2200->dsp[i].cs_dsp.dev = &i2c->dev;
2207 wm2200->dsp[i].cs_dsp.regmap = wm2200->regmap;
2208 wm2200->dsp[i].cs_dsp.sysclk_reg = WM2200_CLOCKING_3;
2209 wm2200->dsp[i].cs_dsp.sysclk_mask = WM2200_SYSCLK_FREQ_MASK;
2210 wm2200->dsp[i].cs_dsp.sysclk_shift = WM2200_SYSCLK_FREQ_SHIFT;
2211 }
2212
2213 wm2200->dsp[0].cs_dsp.base = WM2200_DSP1_CONTROL_1;
2214 wm2200->dsp[0].cs_dsp.mem = wm2200_dsp1_regions;
2215 wm2200->dsp[0].cs_dsp.num_mems = ARRAY_SIZE(wm2200_dsp1_regions);
2216
2217 wm2200->dsp[1].cs_dsp.base = WM2200_DSP2_CONTROL_1;
2218 wm2200->dsp[1].cs_dsp.mem = wm2200_dsp2_regions;
2219 wm2200->dsp[1].cs_dsp.num_mems = ARRAY_SIZE(wm2200_dsp2_regions);
2220
2221 for (i = 0; i < ARRAY_SIZE(wm2200->dsp); i++)
2222 wm_adsp1_init(&wm2200->dsp[i]);
2223
2224 if (pdata)
2225 wm2200->pdata = *pdata;
2226
2227 i2c_set_clientdata(i2c, wm2200);
2228
2229 for (i = 0; i < ARRAY_SIZE(wm2200->core_supplies); i++)
2230 wm2200->core_supplies[i].supply = wm2200_core_supply_names[i];
2231
2232 ret = devm_regulator_bulk_get(&i2c->dev,
2233 ARRAY_SIZE(wm2200->core_supplies),
2234 wm2200->core_supplies);
2235 if (ret != 0) {
2236 dev_err(&i2c->dev, "Failed to request core supplies: %d\n",
2237 ret);
2238 return ret;
2239 }
2240
2241 ret = regulator_bulk_enable(ARRAY_SIZE(wm2200->core_supplies),
2242 wm2200->core_supplies);
2243 if (ret != 0) {
2244 dev_err(&i2c->dev, "Failed to enable core supplies: %d\n",
2245 ret);
2246 return ret;
2247 }
2248
2249 if (wm2200->pdata.ldo_ena) {
2250 ret = devm_gpio_request_one(&i2c->dev, wm2200->pdata.ldo_ena,
2251 GPIOF_OUT_INIT_HIGH,
2252 "WM2200 LDOENA");
2253 if (ret < 0) {
2254 dev_err(&i2c->dev, "Failed to request LDOENA %d: %d\n",
2255 wm2200->pdata.ldo_ena, ret);
2256 goto err_enable;
2257 }
2258 msleep(2);
2259 }
2260
2261 if (wm2200->pdata.reset) {
2262 ret = devm_gpio_request_one(&i2c->dev, wm2200->pdata.reset,
2263 GPIOF_OUT_INIT_HIGH,
2264 "WM2200 /RESET");
2265 if (ret < 0) {
2266 dev_err(&i2c->dev, "Failed to request /RESET %d: %d\n",
2267 wm2200->pdata.reset, ret);
2268 goto err_ldo;
2269 }
2270 }
2271
2272 ret = regmap_read(wm2200->regmap, WM2200_SOFTWARE_RESET, ®);
2273 if (ret < 0) {
2274 dev_err(&i2c->dev, "Failed to read ID register: %d\n", ret);
2275 goto err_reset;
2276 }
2277 switch (reg) {
2278 case 0x2200:
2279 break;
2280
2281 default:
2282 dev_err(&i2c->dev, "Device is not a WM2200, ID is %x\n", reg);
2283 ret = -EINVAL;
2284 goto err_reset;
2285 }
2286
2287 ret = regmap_read(wm2200->regmap, WM2200_DEVICE_REVISION, ®);
2288 if (ret < 0) {
2289 dev_err(&i2c->dev, "Failed to read revision register\n");
2290 goto err_reset;
2291 }
2292
2293 wm2200->rev = reg & WM2200_DEVICE_REVISION_MASK;
2294
2295 dev_info(&i2c->dev, "revision %c\n", wm2200->rev + 'A');
2296
2297 switch (wm2200->rev) {
2298 case 0:
2299 case 1:
2300 ret = regmap_register_patch(wm2200->regmap, wm2200_reva_patch,
2301 ARRAY_SIZE(wm2200_reva_patch));
2302 if (ret != 0) {
2303 dev_err(&i2c->dev, "Failed to register patch: %d\n",
2304 ret);
2305 }
2306 break;
2307 default:
2308 break;
2309 }
2310
2311 ret = wm2200_reset(wm2200);
2312 if (ret < 0) {
2313 dev_err(&i2c->dev, "Failed to issue reset\n");
2314 goto err_reset;
2315 }
2316
2317 for (i = 0; i < ARRAY_SIZE(wm2200->pdata.gpio_defaults); i++) {
2318 if (!wm2200->pdata.gpio_defaults[i])
2319 continue;
2320
2321 regmap_write(wm2200->regmap, WM2200_GPIO_CTRL_1 + i,
2322 wm2200->pdata.gpio_defaults[i]);
2323 }
2324
2325 for (i = 0; i < ARRAY_SIZE(wm2200_dig_vu); i++)
2326 regmap_update_bits(wm2200->regmap, wm2200_dig_vu[i],
2327 WM2200_OUT_VU, WM2200_OUT_VU);
2328
2329
2330 for (i = 0; i < 6; i++) {
2331 regmap_write(wm2200->regmap, WM2200_AUDIO_IF_1_10 + i, i);
2332 regmap_write(wm2200->regmap, WM2200_AUDIO_IF_1_16 + i, i);
2333 }
2334
2335 for (i = 0; i < WM2200_MAX_MICBIAS; i++) {
2336 if (!wm2200->pdata.micbias[i].mb_lvl &&
2337 !wm2200->pdata.micbias[i].bypass)
2338 continue;
2339
2340
2341 if (!wm2200->pdata.micbias[i].mb_lvl)
2342 wm2200->pdata.micbias[i].mb_lvl
2343 = WM2200_MBIAS_LVL_1V5;
2344
2345 val = (wm2200->pdata.micbias[i].mb_lvl -1)
2346 << WM2200_MICB1_LVL_SHIFT;
2347
2348 if (wm2200->pdata.micbias[i].discharge)
2349 val |= WM2200_MICB1_DISCH;
2350
2351 if (wm2200->pdata.micbias[i].fast_start)
2352 val |= WM2200_MICB1_RATE;
2353
2354 if (wm2200->pdata.micbias[i].bypass)
2355 val |= WM2200_MICB1_MODE;
2356
2357 regmap_update_bits(wm2200->regmap,
2358 WM2200_MIC_BIAS_CTRL_1 + i,
2359 WM2200_MICB1_LVL_MASK |
2360 WM2200_MICB1_DISCH |
2361 WM2200_MICB1_MODE |
2362 WM2200_MICB1_RATE, val);
2363 }
2364
2365 for (i = 0; i < ARRAY_SIZE(wm2200->pdata.in_mode); i++) {
2366 regmap_update_bits(wm2200->regmap, wm2200_mic_ctrl_reg[i],
2367 WM2200_IN1_MODE_MASK |
2368 WM2200_IN1_DMIC_SUP_MASK,
2369 (wm2200->pdata.in_mode[i] <<
2370 WM2200_IN1_MODE_SHIFT) |
2371 (wm2200->pdata.dmic_sup[i] <<
2372 WM2200_IN1_DMIC_SUP_SHIFT));
2373 }
2374
2375 if (i2c->irq) {
2376 ret = request_threaded_irq(i2c->irq, NULL, wm2200_irq,
2377 IRQF_TRIGGER_HIGH | IRQF_ONESHOT,
2378 "wm2200", wm2200);
2379 if (ret == 0)
2380 regmap_update_bits(wm2200->regmap,
2381 WM2200_INTERRUPT_STATUS_2_MASK,
2382 WM2200_FLL_LOCK_EINT, 0);
2383 else
2384 dev_err(&i2c->dev, "Failed to request IRQ %d: %d\n",
2385 i2c->irq, ret);
2386 }
2387
2388 pm_runtime_set_active(&i2c->dev);
2389 pm_runtime_enable(&i2c->dev);
2390 pm_request_idle(&i2c->dev);
2391
2392 ret = devm_snd_soc_register_component(&i2c->dev, &soc_component_wm2200,
2393 &wm2200_dai, 1);
2394 if (ret != 0) {
2395 dev_err(&i2c->dev, "Failed to register CODEC: %d\n", ret);
2396 goto err_pm_runtime;
2397 }
2398
2399 return 0;
2400
2401 err_pm_runtime:
2402 pm_runtime_disable(&i2c->dev);
2403 if (i2c->irq)
2404 free_irq(i2c->irq, wm2200);
2405 err_reset:
2406 if (wm2200->pdata.reset)
2407 gpio_set_value_cansleep(wm2200->pdata.reset, 0);
2408 err_ldo:
2409 if (wm2200->pdata.ldo_ena)
2410 gpio_set_value_cansleep(wm2200->pdata.ldo_ena, 0);
2411 err_enable:
2412 regulator_bulk_disable(ARRAY_SIZE(wm2200->core_supplies),
2413 wm2200->core_supplies);
2414 return ret;
2415 }
2416
2417 static int wm2200_i2c_remove(struct i2c_client *i2c)
2418 {
2419 struct wm2200_priv *wm2200 = i2c_get_clientdata(i2c);
2420
2421 pm_runtime_disable(&i2c->dev);
2422 if (i2c->irq)
2423 free_irq(i2c->irq, wm2200);
2424 if (wm2200->pdata.reset)
2425 gpio_set_value_cansleep(wm2200->pdata.reset, 0);
2426 if (wm2200->pdata.ldo_ena)
2427 gpio_set_value_cansleep(wm2200->pdata.ldo_ena, 0);
2428 regulator_bulk_disable(ARRAY_SIZE(wm2200->core_supplies),
2429 wm2200->core_supplies);
2430
2431 return 0;
2432 }
2433
2434 #ifdef CONFIG_PM
2435 static int wm2200_runtime_suspend(struct device *dev)
2436 {
2437 struct wm2200_priv *wm2200 = dev_get_drvdata(dev);
2438
2439 regcache_cache_only(wm2200->regmap, true);
2440 regcache_mark_dirty(wm2200->regmap);
2441 if (wm2200->pdata.ldo_ena)
2442 gpio_set_value_cansleep(wm2200->pdata.ldo_ena, 0);
2443 regulator_bulk_disable(ARRAY_SIZE(wm2200->core_supplies),
2444 wm2200->core_supplies);
2445
2446 return 0;
2447 }
2448
2449 static int wm2200_runtime_resume(struct device *dev)
2450 {
2451 struct wm2200_priv *wm2200 = dev_get_drvdata(dev);
2452 int ret;
2453
2454 ret = regulator_bulk_enable(ARRAY_SIZE(wm2200->core_supplies),
2455 wm2200->core_supplies);
2456 if (ret != 0) {
2457 dev_err(dev, "Failed to enable supplies: %d\n",
2458 ret);
2459 return ret;
2460 }
2461
2462 if (wm2200->pdata.ldo_ena) {
2463 gpio_set_value_cansleep(wm2200->pdata.ldo_ena, 1);
2464 msleep(2);
2465 }
2466
2467 regcache_cache_only(wm2200->regmap, false);
2468 regcache_sync(wm2200->regmap);
2469
2470 return 0;
2471 }
2472 #endif
2473
2474 static const struct dev_pm_ops wm2200_pm = {
2475 SET_RUNTIME_PM_OPS(wm2200_runtime_suspend, wm2200_runtime_resume,
2476 NULL)
2477 };
2478
2479 static const struct i2c_device_id wm2200_i2c_id[] = {
2480 { "wm2200", 0 },
2481 { }
2482 };
2483 MODULE_DEVICE_TABLE(i2c, wm2200_i2c_id);
2484
2485 static struct i2c_driver wm2200_i2c_driver = {
2486 .driver = {
2487 .name = "wm2200",
2488 .pm = &wm2200_pm,
2489 },
2490 .probe_new = wm2200_i2c_probe,
2491 .remove = wm2200_i2c_remove,
2492 .id_table = wm2200_i2c_id,
2493 };
2494
2495 module_i2c_driver(wm2200_i2c_driver);
2496
2497 MODULE_DESCRIPTION("ASoC WM2200 driver");
2498 MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfsonmicro.com>");
2499 MODULE_LICENSE("GPL");