~ [ source navigation ] ~ [ diff markup ] ~ [ identifier search ] ~

TOMOYO Linux Cross Reference
Linux/sound/soc/codecs/rtq9128.c

Version: ~ [ linux-6.12-rc7 ] ~ [ linux-6.11.7 ] ~ [ linux-6.10.14 ] ~ [ linux-6.9.12 ] ~ [ linux-6.8.12 ] ~ [ linux-6.7.12 ] ~ [ linux-6.6.60 ] ~ [ linux-6.5.13 ] ~ [ linux-6.4.16 ] ~ [ linux-6.3.13 ] ~ [ linux-6.2.16 ] ~ [ linux-6.1.116 ] ~ [ linux-6.0.19 ] ~ [ linux-5.19.17 ] ~ [ linux-5.18.19 ] ~ [ linux-5.17.15 ] ~ [ linux-5.16.20 ] ~ [ linux-5.15.171 ] ~ [ linux-5.14.21 ] ~ [ linux-5.13.19 ] ~ [ linux-5.12.19 ] ~ [ linux-5.11.22 ] ~ [ linux-5.10.229 ] ~ [ linux-5.9.16 ] ~ [ linux-5.8.18 ] ~ [ linux-5.7.19 ] ~ [ linux-5.6.19 ] ~ [ linux-5.5.19 ] ~ [ linux-5.4.285 ] ~ [ linux-5.3.18 ] ~ [ linux-5.2.21 ] ~ [ linux-5.1.21 ] ~ [ linux-5.0.21 ] ~ [ linux-4.20.17 ] ~ [ linux-4.19.323 ] ~ [ linux-4.18.20 ] ~ [ linux-4.17.19 ] ~ [ linux-4.16.18 ] ~ [ linux-4.15.18 ] ~ [ linux-4.14.336 ] ~ [ linux-4.13.16 ] ~ [ linux-4.12.14 ] ~ [ linux-4.11.12 ] ~ [ linux-4.10.17 ] ~ [ linux-4.9.337 ] ~ [ linux-4.4.302 ] ~ [ linux-3.10.108 ] ~ [ linux-2.6.32.71 ] ~ [ linux-2.6.0 ] ~ [ linux-2.4.37.11 ] ~ [ unix-v6-master ] ~ [ ccs-tools-1.8.12 ] ~ [ policy-sample ] ~
Architecture: ~ [ i386 ] ~ [ alpha ] ~ [ m68k ] ~ [ mips ] ~ [ ppc ] ~ [ sparc ] ~ [ sparc64 ] ~

Diff markup

Differences between /sound/soc/codecs/rtq9128.c (Version linux-6.12-rc7) and /sound/soc/codecs/rtq9128.c (Version linux-5.16.20)


  1 // SPDX-License-Identifier: GPL-2.0-only            1 
  2 //                                                
  3 // Copyright (c) 2023 Richtek Technology Corp.    
  4 //                                                
  5 // Author: ChiYuan Huang <cy_huang@richtek.com    
  6 //                                                
  7                                                   
  8 #include <linux/bitfield.h>                       
  9 #include <linux/bits.h>                           
 10 #include <linux/delay.h>                          
 11 #include <linux/gpio/consumer.h>                  
 12 #include <linux/i2c.h>                            
 13 #include <linux/kernel.h>                         
 14 #include <linux/mod_devicetable.h>                
 15 #include <linux/module.h>                         
 16 #include <linux/pm_runtime.h>                     
 17 #include <linux/property.h>                       
 18 #include <linux/regmap.h>                         
 19 #include <sound/pcm_params.h>                     
 20 #include <sound/soc.h>                            
 21 #include <sound/tlv.h>                            
 22                                                   
 23 #define RTQ9128_REG_SDI_SEL     0x00              
 24 #define RTQ9128_REG_SDO_SEL     0x01              
 25 #define RTQ9128_REG_I2S_OPT     0x02              
 26 #define RTQ9128_REG_MISC        0x03              
 27 #define RTQ9128_REG_STATE_CTRL  0x04              
 28 #define RTQ9128_REG_PLLTRI_GEN1 0x05              
 29 #define RTQ9128_REG_PLLTRI_GEN2 0x06              
 30 #define RTQ9128_REG_PWM_SS_OPT  0x07              
 31 #define RTQ9128_REG_DSP_EN      0x08              
 32 #define RTQ9128_REG_TDM_TX_CH1  0x21              
 33 #define RTQ9128_REG_TDM_RX_CH1  0x25              
 34 #define RTQ9128_REG_MS_VOL      0x30              
 35 #define RTQ9128_REG_CH1_VOL     0x31              
 36 #define RTQ9128_REG_CH2_VOL     0x32              
 37 #define RTQ9128_REG_CH3_VOL     0x33              
 38 #define RTQ9128_REG_CH4_VOL     0x34              
 39 #define RTQ9128_REG_PROT_OPT    0x71              
 40 #define RTQ9128_REG_EFUSE_DATA  0xE0              
 41 #define RTQ9128_REG_VENDOR_ID   0xF9              
 42                                                   
 43 #define RTQ9128_CHSTAT_VAL_MASK GENMASK(1, 0)     
 44 #define RTQ9128_DOLEN_MASK      GENMASK(7, 6)     
 45 #define RTQ9128_TDMSRCIN_MASK   GENMASK(5, 4)     
 46 #define RTQ9128_AUDBIT_MASK     GENMASK(5, 4)     
 47 #define RTQ9128_AUDFMT_MASK     GENMASK(3, 0)     
 48 #define RTQ9128_MSMUTE_MASK     BIT(0)            
 49 #define RTQ9128_DIE_CHECK_MASK  GENMASK(4, 0)     
 50 #define RTQ9128_VENDOR_ID_MASK  GENMASK(19, 8)    
 51                                                   
 52 #define RTQ9128_SOFT_RESET_VAL  0x80              
 53 #define RTQ9128_VENDOR_ID_VAL   0x470             
 54 #define RTQ9128_ALLCH_HIZ_VAL   0x55              
 55 #define RTQ9128_ALLCH_ULQM_VAL  0xFF              
 56 #define RTQ9128_TKA470B_VAL     0                 
 57 #define RTQ9128_RTQ9128DH_VAL   0x0F              
 58 #define RTQ9128_RTQ9128DL_VAL   0x10              
 59                                                   
 60 struct rtq9128_data {                             
 61         struct gpio_desc *enable;                 
 62         unsigned int daifmt;                      
 63         int tdm_slots;                            
 64         int tdm_slot_width;                       
 65         bool tdm_input_data2_select;              
 66 };                                                
 67                                                   
 68 struct rtq9128_init_reg {                         
 69         unsigned int reg;                         
 70         unsigned int val;                         
 71 };                                                
 72                                                   
 73 static int rtq9128_get_reg_size(unsigned int r    
 74 {                                                 
 75         switch (reg) {                            
 76         case 0x5C ... 0x6F:                       
 77         case 0x98 ... 0x9F:                       
 78         case 0xC0 ... 0xC3:                       
 79         case 0xC8 ... 0xCF:                       
 80         case 0xDF ... 0xE5:                       
 81         case 0xF9:                                
 82                 return 4;                         
 83         case 0x40 ... 0x4F:                       
 84                 return 3;                         
 85         case 0x30 ... 0x35:                       
 86         case 0x8C ... 0x97:                       
 87         case 0xC4 ... 0xC7:                       
 88         case 0xD7 ... 0xDA:                       
 89                 return 2;                         
 90         default:                                  
 91                 return 1;                         
 92         }                                         
 93 }                                                 
 94                                                   
 95 static int rtq9128_i2c_write(void *context, co    
 96 {                                                 
 97         struct device *dev = context;             
 98         struct i2c_client *i2c = to_i2c_client    
 99         u8 reg = *(u8 *)data;                     
100         int rg_size;                              
101                                                   
102         if (count != 5) {                         
103                 dev_err(dev, "Invalid write fo    
104                 return -EINVAL;                   
105         }                                         
106                                                   
107         rg_size = rtq9128_get_reg_size(reg);      
108         return i2c_smbus_write_i2c_block_data(    
109 }                                                 
110                                                   
111 static int rtq9128_i2c_read(void *context, con    
112                             size_t val_size)      
113 {                                                 
114         struct device *dev = context;             
115         struct i2c_client *i2c = to_i2c_client    
116         u8 reg = *(u8 *)reg_buf;                  
117         u8 data_tmp[4] = {};                      
118         int rg_size, ret;                         
119                                                   
120         if (reg_size != 1 || val_size != 4) {     
121                 dev_err(dev, "Invalid read for    
122                         (int)val_size);           
123                 return -EINVAL;                   
124         }                                         
125                                                   
126         rg_size = rtq9128_get_reg_size(reg);      
127         ret = i2c_smbus_read_i2c_block_data(i2    
128         if (ret < 0)                              
129                 return ret;                       
130         else if (ret != rg_size)                  
131                 return -EIO;                      
132                                                   
133         memset(val_buf, 0, val_size - rg_size)    
134         memcpy(val_buf + val_size - rg_size, d    
135                                                   
136         return 0;                                 
137 }                                                 
138                                                   
139 static const struct regmap_bus rtq9128_regmap_    
140         .write = rtq9128_i2c_write,               
141         .read = rtq9128_i2c_read,                 
142         .max_raw_read = 4,                        
143         .max_raw_write = 4,                       
144 };                                                
145                                                   
146 static bool rtq9128_is_readable_reg(struct dev    
147 {                                                 
148         switch (reg) {                            
149         case 0x00 ... 0x2B:                       
150         case 0x30 ... 0x35:                       
151         case 0x40 ... 0x56:                       
152         case 0x5C ... 0x76:                       
153         case 0x80 ... 0xAD:                       
154         case 0xB0 ... 0xBA:                       
155         case 0xC0 ... 0xE5:                       
156         case 0xF0 ... 0xFB:                       
157                 return true;                      
158         default:                                  
159                 return false;                     
160         }                                         
161 }                                                 
162                                                   
163 static bool rtq9128_is_writeable_reg(struct de    
164 {                                                 
165         switch (reg) {                            
166         case 0x00 ... 0x1F:                       
167         case 0x21 ... 0x2B:                       
168         case 0x30 ... 0x35:                       
169         case 0x40 ... 0x56:                       
170         case 0x5C ... 0x76:                       
171         case 0x80 ... 0x8B:                       
172         case 0xA0 ... 0xAD:                       
173         case 0xB0 ... 0xBA:                       
174         case 0xC0:                                
175         case 0xD0 ... 0xDE:                       
176         case 0xE0 ... 0xE5:                       
177         case 0xF0 ... 0xF3:                       
178         case 0xF6 ... 0xF8:                       
179         case 0xFA ... 0xFB:                       
180                 return true;                      
181         default:                                  
182                 return false;                     
183         }                                         
184 }                                                 
185                                                   
186 static bool rtq9128_is_volatile_reg(struct dev    
187 {                                                 
188         switch (reg) {                            
189         case 0x0F ... 0x17:                       
190         case 0x20:                                
191         case 0x53:                                
192         case 0x55:                                
193         case 0x5C ... 0x6F:                       
194         case 0x8C ... 0x9F:                       
195         case 0xC0 ... 0xCF:                       
196         case 0xDF:                                
197         case 0xF0 ... 0xF1:                       
198         case 0xF4 ... 0xF5:                       
199                 return true;                      
200         default:                                  
201                 return false;                     
202         }                                         
203 }                                                 
204                                                   
205 static const struct regmap_config rtq9128_regm    
206         .name = "rtq9128",                        
207         .reg_bits = 8,                            
208         .val_bits = 32,                           
209         .val_format_endian = REGMAP_ENDIAN_BIG    
210         .cache_type = REGCACHE_MAPLE,             
211                                                   
212         .readable_reg = rtq9128_is_readable_re    
213         .writeable_reg = rtq9128_is_writeable_    
214         .volatile_reg = rtq9128_is_volatile_re    
215         .num_reg_defaults_raw = RTQ9128_REG_VE    
216 };                                                
217                                                   
218 static const DECLARE_TLV_DB_SCALE(dig_tlv, -10    
219                                                   
220 static const DECLARE_TLV_DB_RANGE(spkgain_tlv,    
221         0, 3, TLV_DB_SCALE_ITEM(-600, 600, 0),    
222         4, 5, TLV_DB_SCALE_ITEM(1500, 300, 0),    
223 );                                                
224                                                   
225 static const char * const source_select_text[]    
226 static const char * const pwmfreq_select_text[    
227 static const char * const phase_select_text[]     
228         "0 degree",     "45 degree",    "90 de    
229         "180 degree",   "225 degree",   "270 d    
230 };                                                
231 static const char * const dvdduv_select_text[]    
232                                                   
233 static const struct soc_enum rtq9128_ch1_si_en    
234         SOC_ENUM_SINGLE(RTQ9128_REG_SDI_SEL, 6    
235 static const struct soc_enum rtq9128_ch2_si_en    
236         SOC_ENUM_SINGLE(RTQ9128_REG_SDI_SEL, 4    
237 static const struct soc_enum rtq9128_ch3_si_en    
238         SOC_ENUM_SINGLE(RTQ9128_REG_SDI_SEL, 2    
239 static const struct soc_enum rtq9128_ch4_si_en    
240         SOC_ENUM_SINGLE(RTQ9128_REG_SDI_SEL, 0    
241 static const struct soc_enum rtq9128_pwm_freq_    
242         SOC_ENUM_SINGLE(RTQ9128_REG_PLLTRI_GEN    
243                         pwmfreq_select_text);     
244 static const struct soc_enum rtq9128_out2_phas    
245         SOC_ENUM_SINGLE(RTQ9128_REG_PLLTRI_GEN    
246                         phase_select_text);       
247 static const struct soc_enum rtq9128_out3_phas    
248         SOC_ENUM_SINGLE(RTQ9128_REG_PLLTRI_GEN    
249                         phase_select_text);       
250 static const struct soc_enum rtq9128_out4_phas    
251         SOC_ENUM_SINGLE(RTQ9128_REG_PLLTRI_GEN    
252                         phase_select_text);       
253                                                   
254 /*                                                
255  * In general usage, DVDD could be 1P8V, 3P0V     
256  * This DVDD undervoltage protection is to pre    
257  * lose case while the amplifier is operating.    
258  * application, treat this threshold as a user    
259  */                                               
260 static const struct soc_enum rtq9128_dvdduv_se    
261         SOC_ENUM_SINGLE(RTQ9128_REG_PROT_OPT,     
262                         dvdduv_select_text);      
263                                                   
264 static const struct snd_kcontrol_new rtq9128_s    
265         SOC_SINGLE_TLV("MS Volume", RTQ9128_RE    
266         SOC_SINGLE_TLV("CH1 Volume", RTQ9128_R    
267         SOC_SINGLE_TLV("CH2 Volume", RTQ9128_R    
268         SOC_SINGLE_TLV("CH3 Volume", RTQ9128_R    
269         SOC_SINGLE_TLV("CH4 Volume", RTQ9128_R    
270         SOC_SINGLE_TLV("SPK Gain Volume", RTQ9    
271         SOC_SINGLE("PBTL12 Switch", RTQ9128_RE    
272         SOC_SINGLE("PBTL34 Switch", RTQ9128_RE    
273         SOC_SINGLE("Spread Spectrum Switch", R    
274         SOC_SINGLE("SDO Select", RTQ9128_REG_S    
275         SOC_ENUM("CH1 SI Select", rtq9128_ch1_    
276         SOC_ENUM("CH2 SI Select", rtq9128_ch2_    
277         SOC_ENUM("CH3 SI Select", rtq9128_ch3_    
278         SOC_ENUM("CH4 SI Select", rtq9128_ch4_    
279         SOC_ENUM("PWM FREQ Select", rtq9128_pw    
280         SOC_ENUM("OUT2 Phase Select", rtq9128_    
281         SOC_ENUM("OUT3 Phase Select", rtq9128_    
282         SOC_ENUM("OUT4 Phase Select", rtq9128_    
283         SOC_ENUM("DVDD UV Threshold Select", r    
284 };                                                
285                                                   
286 static int rtq9128_dac_power_event(struct snd_    
287                                    int event)     
288 {                                                 
289         struct snd_soc_component *comp = snd_s    
290         unsigned int shift, mask;                 
291         int ret;                                  
292                                                   
293         dev_dbg(comp->dev, "%s: %s event %d\n"    
294                                                   
295         if (snd_soc_dapm_widget_name_cmp(w, "D    
296                 shift = 6;                        
297         else if (snd_soc_dapm_widget_name_cmp(    
298                 shift = 4;                        
299         else if (snd_soc_dapm_widget_name_cmp(    
300                 shift = 2;                        
301         else                                      
302                 shift = 0;                        
303                                                   
304         mask = RTQ9128_CHSTAT_VAL_MASK << shif    
305                                                   
306         /* Turn channel state to Normal or HiZ    
307         ret = snd_soc_component_write_field(co    
308                                             ev    
309         if (ret < 0)                              
310                 return ret;                       
311                                                   
312         /*                                        
313          * For each channel turns on, HW will     
314          * offset calibration, the time is nee    
315          */                                       
316         if (event == SND_SOC_DAPM_POST_PMU)       
317                 msleep(25);                       
318                                                   
319         return 0;                                 
320 }                                                 
321                                                   
322 static const struct snd_soc_dapm_widget rtq912    
323         SND_SOC_DAPM_DAC_E("DAC1", NULL, SND_S    
324                            SND_SOC_DAPM_POST_P    
325         SND_SOC_DAPM_DAC_E("DAC2", NULL, SND_S    
326                            SND_SOC_DAPM_POST_P    
327         SND_SOC_DAPM_DAC_E("DAC3", NULL, SND_S    
328                            SND_SOC_DAPM_POST_P    
329         SND_SOC_DAPM_DAC_E("DAC4", NULL, SND_S    
330                            SND_SOC_DAPM_POST_P    
331         SND_SOC_DAPM_OUTPUT("OUT1"),              
332         SND_SOC_DAPM_OUTPUT("OUT2"),              
333         SND_SOC_DAPM_OUTPUT("OUT3"),              
334         SND_SOC_DAPM_OUTPUT("OUT4"),              
335 };                                                
336                                                   
337 static const struct snd_soc_dapm_route rtq9128    
338         { "DAC1", NULL, "Playback" },             
339         { "DAC2", NULL, "Playback" },             
340         { "DAC3", NULL, "Playback" },             
341         { "DAC4", NULL, "Playback" },             
342         { "OUT1", NULL, "DAC1" },                 
343         { "OUT2", NULL, "DAC2" },                 
344         { "OUT3", NULL, "DAC3" },                 
345         { "OUT4", NULL, "DAC4" },                 
346         { "Capture", NULL, "DAC1" },              
347         { "Capture", NULL, "DAC2" },              
348         { "Capture", NULL, "DAC3" },              
349         { "Capture", NULL, "DAC4" },              
350 };                                                
351                                                   
352 static const struct rtq9128_init_reg rtq9128_t    
353         { 0xA0, 0xEF },                           
354         { 0x0D, 0x00 },                           
355         { 0x03, 0x05 },                           
356         { 0x05, 0x31 },                           
357         { 0x06, 0x23 },                           
358         { 0x70, 0x11 },                           
359         { 0x75, 0x1F },                           
360         { 0xB6, 0x03 },                           
361         { 0xB9, 0x03 },                           
362         { 0xB8, 0x03 },                           
363         { 0xC1, 0xFF },                           
364         { 0xF8, 0x72 },                           
365         { 0x30, 0x180 },                          
366 };                                                
367                                                   
368 static const struct rtq9128_init_reg rtq9128_d    
369         { 0x0F, 0x00 },                           
370         { 0x03, 0x0D },                           
371         { 0xB2, 0xFF },                           
372         { 0xB3, 0xFF },                           
373         { 0x30, 0x180 },                          
374         { 0x8A, 0x55 },                           
375         { 0x72, 0x00 },                           
376         { 0xB1, 0xE3 },                           
377 };                                                
378                                                   
379 static const struct rtq9128_init_reg rtq9128_d    
380         { 0x0F, 0x00 },                           
381         { 0x03, 0x0D },                           
382         { 0x30, 0x180 },                          
383         { 0x8A, 0x55 },                           
384         { 0x72, 0x00 },                           
385         { 0xB1, 0xE3 },                           
386 };                                                
387                                                   
388 static int rtq9128_component_probe(struct snd_    
389 {                                                 
390         const struct rtq9128_init_reg *table,     
391         size_t table_size;                        
392         unsigned int val;                         
393         int i, ret;                               
394                                                   
395         ret = pm_runtime_resume_and_get(comp->    
396         if (ret < 0) {                            
397                 dev_err(comp->dev, "Failed to     
398                 return ret;                       
399         }                                         
400                                                   
401         val = snd_soc_component_read(comp, RTQ    
402                                                   
403         switch (FIELD_GET(RTQ9128_DIE_CHECK_MA    
404         case RTQ9128_TKA470B_VAL:                 
405                 table = rtq9128_tka470b_tables    
406                 table_size = ARRAY_SIZE(rtq912    
407                 break;                            
408         case RTQ9128_RTQ9128DH_VAL:               
409                 table = rtq9128_dh_tables;        
410                 table_size = ARRAY_SIZE(rtq912    
411                 break;                            
412         default:                                  
413                 table = rtq9128_dl_tables;        
414                 table_size = ARRAY_SIZE(rtq912    
415                 break;                            
416         }                                         
417                                                   
418         for (i = 0, curr = table; i < table_si    
419                 ret = snd_soc_component_write(    
420                 if (ret < 0)                      
421                         return ret;               
422         }                                         
423                                                   
424         pm_runtime_mark_last_busy(comp->dev);     
425         pm_runtime_put(comp->dev);                
426                                                   
427         return 0;                                 
428 }                                                 
429                                                   
430 static const struct snd_soc_component_driver r    
431         .probe = rtq9128_component_probe,         
432         .controls = rtq9128_snd_ctrls,            
433         .num_controls = ARRAY_SIZE(rtq9128_snd    
434         .dapm_widgets = rtq9128_dapm_widgets,     
435         .num_dapm_widgets = ARRAY_SIZE(rtq9128    
436         .dapm_routes = rtq9128_dapm_routes,       
437         .num_dapm_routes = ARRAY_SIZE(rtq9128_    
438         .use_pmdown_time = 1,                     
439         .endianness = 1,                          
440 };                                                
441                                                   
442 static int rtq9128_dai_set_fmt(struct snd_soc_    
443 {                                                 
444         struct rtq9128_data *data = snd_soc_da    
445         struct device *dev = dai->dev;            
446                                                   
447         dev_dbg(dev, "%s: fmt 0x%8x\n", __func    
448                                                   
449         /* Only support bitclock & framesync a    
450         if ((fmt & SND_SOC_DAIFMT_MASTER_MASK)    
451                 dev_err(dev, "Only support BCK    
452                 return -EINVAL;                   
453         }                                         
454                                                   
455         /* Store here and will be used in runt    
456         data->daifmt = fmt;                       
457                                                   
458         return 0;                                 
459 }                                                 
460                                                   
461 static int rtq9128_dai_set_tdm_slot(struct snd    
462                                     unsigned i    
463 {                                                 
464         struct rtq9128_data *data = snd_soc_da    
465         struct snd_soc_component *comp = dai->    
466         struct device *dev = dai->dev;            
467         unsigned int mask, start_loc, srcin_se    
468         int i, frame_length, ret;                 
469                                                   
470         dev_dbg(dev, "%s: slot %d slot_width %    
471                 slot_width, tx_mask, rx_mask);    
472                                                   
473         if (slots <= 0 || slot_width <= 0 || s    
474                 dev_err(dev, "Invalid slot num    
475                 return -EINVAL;                   
476         }                                         
477                                                   
478         /* HW supported maximum frame length 5    
479         frame_length = slots * slot_width;        
480         if (frame_length > 512) {                 
481                 dev_err(dev, "frame length exc    
482                 return -EINVAL;                   
483         }                                         
484                                                   
485         if (!rx_mask || hweight_long(tx_mask)     
486             fls(tx_mask) > slots || fls(rx_mas    
487                 dev_err(dev, "Invalid tx/rx ma    
488                 return -EINVAL;                   
489         }                                         
490                                                   
491         for (mask = tx_mask, i = 0; i < 4 && m    
492                 start_loc = (ffs(mask) - 1) *     
493                 mask &= ~BIT(ffs(mask) - 1);      
494                                                   
495                 ret = snd_soc_component_write(    
496                 if (ret < 0) {                    
497                         dev_err(dev, "Failed t    
498                         return ret;               
499                 }                                 
500         }                                         
501                                                   
502         for (mask = rx_mask, i = 0; i < 4 && m    
503                 start_loc = (ffs(mask) - 1) *     
504                 mask &= ~BIT(ffs(mask) - 1);      
505                                                   
506                 ret = snd_soc_component_write(    
507                 if (ret < 0) {                    
508                         dev_err(dev, "Failed t    
509                         return ret;               
510                 }                                 
511         }                                         
512                                                   
513         srcin_select = data->tdm_input_data2_s    
514         ret = snd_soc_component_update_bits(co    
515                                             sr    
516         if (ret < 0) {                            
517                 dev_err(dev, "Failed to config    
518                 return ret;                       
519         }                                         
520                                                   
521         data->tdm_slots = slots;                  
522         data->tdm_slot_width = slot_width;        
523                                                   
524         return 0;                                 
525 }                                                 
526                                                   
527 static int rtq9128_dai_hw_params(struct snd_pc    
528                                  struct snd_so    
529 {                                                 
530         struct rtq9128_data *data = snd_soc_da    
531         unsigned int width, slot_width, bitrat    
532         struct snd_soc_component *comp = dai->    
533         struct device *dev = dai->dev;            
534         unsigned int fmtval, audfmt;              
535         int ret;                                  
536                                                   
537         dev_dbg(dev, "%s: width %d\n", __func_    
538                                                   
539         fmtval = FIELD_GET(SND_SOC_DAIFMT_FORM    
540         if (data->tdm_slots && fmtval != SND_S    
541                 dev_err(dev, "TDM is used, for    
542                 return -EINVAL;                   
543         }                                         
544                                                   
545         switch (fmtval) {                         
546         case SND_SOC_DAIFMT_I2S:                  
547                 audfmt = 8;                       
548                 break;                            
549         case SND_SOC_DAIFMT_LEFT_J:               
550                 audfmt = 9;                       
551                 break;                            
552         case SND_SOC_DAIFMT_RIGHT_J:              
553                 audfmt = 10;                      
554                 break;                            
555         case SND_SOC_DAIFMT_DSP_A:                
556                 audfmt = data->tdm_slots ? 12     
557                 break;                            
558         case SND_SOC_DAIFMT_DSP_B:                
559                 audfmt = data->tdm_slots ? 4 :    
560                 break;                            
561         default:                                  
562                 dev_err(dev, "Unsupported form    
563                 return -EINVAL;                   
564         }                                         
565                                                   
566         switch (width = params_width(param)) {    
567         case 16:                                  
568                 audbit = 0;                       
569                 break;                            
570         case 18:                                  
571                 audbit = 1;                       
572                 break;                            
573         case 20:                                  
574                 audbit = 2;                       
575                 break;                            
576         case 24:                                  
577         case 32:                                  
578                 audbit = 3;                       
579                 break;                            
580         default:                                  
581                 dev_err(dev, "Unsupported widt    
582                 return -EINVAL;                   
583         }                                         
584                                                   
585         slot_width = params_physical_width(par    
586                                                   
587         if (data->tdm_slots) {                    
588                 if (slot_width > data->tdm_slo    
589                         dev_err(dev, "slot wid    
590                         return -EINVAL;           
591                 }                                 
592                                                   
593                 /* Check BCK not exceed the ma    
594                 bitrate = data->tdm_slots * da    
595                 if (bitrate > 24576000) {         
596                         dev_err(dev, "bitrate     
597                         return -EINVAL;           
598                 }                                 
599                                                   
600                 /* If TDM is used, configure s    
601                 slot_width = data->tdm_slot_wi    
602         }                                         
603                                                   
604         switch (slot_width) {                     
605         case 16:                                  
606                 dolen = 0;                        
607                 break;                            
608         case 24:                                  
609                 dolen = 1;                        
610                 break;                            
611         case 32:                                  
612                 dolen = 2;                        
613                 break;                            
614         default:                                  
615                 dev_err(dev, "Unsupported slot    
616                 return -EINVAL;                   
617         }                                         
618                                                   
619         ret = snd_soc_component_write_field(co    
620         if (ret < 0)                              
621                 return ret;                       
622                                                   
623         ret = snd_soc_component_write_field(co    
624         if (ret < 0)                              
625                 return ret;                       
626                                                   
627         ret = snd_soc_component_write_field(co    
628         return ret < 0 ? ret : 0;                 
629 }                                                 
630                                                   
631 static int rtq9128_dai_mute_stream(struct snd_    
632 {                                                 
633         struct snd_soc_component *comp = dai->    
634         struct device *dev = dai->dev;            
635         int ret;                                  
636                                                   
637         dev_dbg(dev, "%s: mute (%d), stream (%    
638                                                   
639         ret = snd_soc_component_write_field(co    
640                                             mu    
641         return ret < 0 ? ret : 0;                 
642 }                                                 
643                                                   
644 static const struct snd_soc_dai_ops rtq9128_da    
645         .set_fmt = rtq9128_dai_set_fmt,           
646         .set_tdm_slot = rtq9128_dai_set_tdm_sl    
647         .hw_params = rtq9128_dai_hw_params,       
648         .mute_stream = rtq9128_dai_mute_stream    
649         .no_capture_mute = 1,                     
650 };                                                
651                                                   
652 #define RTQ9128_FMTS_MASK       (SNDRV_PCM_FMT    
653                                  SNDRV_PCM_FMT    
654                                  SNDRV_PCM_FMT    
655                                                   
656 static struct snd_soc_dai_driver rtq9128_dai =    
657         .name = "rtq9128-aif",                    
658         .playback = {                             
659                 .stream_name = "Playback",        
660                 .rates = SNDRV_PCM_RATE_8000_1    
661                 .formats = RTQ9128_FMTS_MASK,     
662                 .channels_min = 1,                
663                 .channels_max = 4,                
664         },                                        
665         .capture = {                              
666                 .stream_name = "Capture",         
667                 .rates = SNDRV_PCM_RATE_8000_1    
668                 .formats = RTQ9128_FMTS_MASK,     
669                 .channels_min = 1,                
670                 .channels_max = 4,                
671         },                                        
672         .ops = &rtq9128_dai_ops,                  
673         .symmetric_rate = 1,                      
674         .symmetric_sample_bits = 1,               
675 };                                                
676                                                   
677 static int rtq9128_probe(struct i2c_client *i2    
678 {                                                 
679         struct device *dev = &i2c->dev;           
680         struct rtq9128_data *data;                
681         struct regmap *regmap;                    
682         unsigned int venid;                       
683         int ret;                                  
684                                                   
685         data = devm_kzalloc(dev, sizeof(*data)    
686         if (!data)                                
687                 return -ENOMEM;                   
688                                                   
689         data->enable = devm_gpiod_get_optional    
690         if (IS_ERR(data->enable))                 
691                 return dev_err_probe(dev, PTR_    
692         else if (data->enable)                    
693                 usleep_range(10000, 11000);       
694                                                   
695         data->tdm_input_data2_select = device_    
696                                                   
697                                                   
698         i2c_set_clientdata(i2c, data);            
699                                                   
700         /*                                        
701          * Due to the bad design to combine SO    
702          * directly use generic i2c API to tri    
703          */                                       
704         ret = i2c_smbus_write_byte_data(i2c, R    
705         if (ret)                                  
706                 return dev_err_probe(dev, ret,    
707                                                   
708         /* After trigger soft reset, have to w    
709         usleep_range(10000, 11000);               
710                                                   
711         regmap = devm_regmap_init(dev, &rtq912    
712         if (IS_ERR(regmap))                       
713                 return dev_err_probe(dev, PTR_    
714                                                   
715         ret = regmap_read(regmap, RTQ9128_REG_    
716         if (ret)                                  
717                 return dev_err_probe(dev, ret,    
718                                                   
719         venid = FIELD_GET(RTQ9128_VENDOR_ID_MA    
720         if (venid != RTQ9128_VENDOR_ID_VAL)       
721                 return dev_err_probe(dev, -ENO    
722                                                   
723         pm_runtime_set_active(dev);               
724         pm_runtime_mark_last_busy(dev);           
725         ret = devm_pm_runtime_enable(dev);        
726         if (ret)                                  
727                 return dev_err_probe(dev, ret,    
728                                                   
729         return devm_snd_soc_register_component    
730 }                                                 
731                                                   
732 static int __maybe_unused rtq9128_pm_runtime_s    
733 {                                                 
734         struct rtq9128_data *data = dev_get_dr    
735         struct regmap *regmap = dev_get_regmap    
736                                                   
737         /* If 'enable' gpio not specified, cha    
738         if (!data->enable)                        
739                 return regmap_write(regmap, RT    
740                                                   
741         gpiod_set_value_cansleep(data->enable,    
742                                                   
743         regcache_cache_only(regmap, true);        
744         regcache_mark_dirty(regmap);              
745                                                   
746         return 0;                                 
747 }                                                 
748                                                   
749 static int __maybe_unused rtq9128_pm_runtime_r    
750 {                                                 
751         struct rtq9128_data *data = dev_get_dr    
752         struct regmap *regmap = dev_get_regmap    
753                                                   
754         /* If 'enable' gpio not specified, cha    
755         if (!data->enable)                        
756                 return regmap_write(regmap, RT    
757                                                   
758         gpiod_set_value_cansleep(data->enable,    
759                                                   
760         /* Wait digital block to be ready */      
761         usleep_range(10000, 11000);               
762                                                   
763         regcache_cache_only(regmap, false);       
764         return regcache_sync(regmap);             
765 }                                                 
766                                                   
767 static const struct dev_pm_ops __maybe_unused     
768         SET_RUNTIME_PM_OPS(rtq9128_pm_runtime_    
769 };                                                
770                                                   
771 static const struct of_device_id rtq9128_devic    
772         { .compatible = "richtek,rtq9128" },      
773         {}                                        
774 };                                                
775 MODULE_DEVICE_TABLE(of, rtq9128_device_table);    
776                                                   
777 static struct i2c_driver rtq9128_driver = {       
778         .driver = {                               
779                 .name = "rtq9128",                
780                 .of_match_table = rtq9128_devi    
781                 .pm = pm_ptr(&rtq9128_pm_ops),    
782         },                                        
783         .probe = rtq9128_probe,                   
784 };                                                
785 module_i2c_driver(rtq9128_driver);                
786                                                   
787 MODULE_AUTHOR("ChiYuan Huang <cy_huang@richtek    
788 MODULE_DESCRIPTION("RTQ9128 4CH Audio Amplifie    
789 MODULE_LICENSE("GPL");                            
790                                                   

~ [ source navigation ] ~ [ diff markup ] ~ [ identifier search ] ~

kernel.org | git.kernel.org | LWN.net | Project Home | SVN repository | Mail admin

Linux® is a registered trademark of Linus Torvalds in the United States and other countries.
TOMOYO® is a registered trademark of NTT DATA CORPORATION.

sflogo.php