1 // SPDX-License-Identifier: GPL-2.0 2 // 3 // ALSA SoC Texas Instruments TAS2783 Audio Smart Amplifier 4 // 5 // Copyright (C) 2025 Texas Instruments Incorporated 6 // https://www.ti.com 7 // 8 // The TAS2783 driver implements a flexible and configurable 9 // algo coefficient setting for single TAS2783 chips. 10 // 11 // Author: Niranjan H Y <niranjanhy@ti.com> 12 // Author: Baojun Xu <baojun.xu@ti.com> 13 // Author: Kevin Lu <kevin-lu@ti.com> 14 15 #include <linux/unaligned.h> 16 #include <linux/crc32.h> 17 #include <linux/efi.h> 18 #include <linux/err.h> 19 #include <linux/firmware.h> 20 #include <linux/init.h> 21 #include <linux/module.h> 22 #include <sound/pcm_params.h> 23 #include <linux/pm.h> 24 #include <linux/pm_runtime.h> 25 #include <linux/regmap.h> 26 #include <linux/wait.h> 27 #include <linux/soundwire/sdw.h> 28 #include <linux/soundwire/sdw_registers.h> 29 #include <linux/soundwire/sdw_type.h> 30 #if IS_ENABLED(CONFIG_PCI) 31 #include <linux/pci.h> 32 #endif 33 #include <sound/sdw.h> 34 #include <sound/soc.h> 35 #include <sound/tlv.h> 36 #include <sound/tas2781-tlv.h> 37 #include <sound/sdca_function.h> 38 #include <sound/sdca_regmap.h> 39 40 #include "tas2783.h" 41 42 #define TIMEOUT_FW_DL_MS (3000) 43 #define FW_DL_OFFSET 84 /* binary file information */ 44 #define FW_FL_HDR 20 /* minimum number of bytes in one chunk */ 45 #define TAS2783_PROBE_TIMEOUT 5000 46 #define TAS2783_CALI_GUID EFI_GUID(0x1f52d2a1, 0xbb3a, 0x457d, 0xbc, \ 47 0x09, 0x43, 0xa3, 0xf4, 0x31, 0x0a, 0x92) 48 49 static const u32 tas2783_cali_reg[] = { 50 TAS2783_CAL_R0, 51 TAS2783_CAL_INVR0, 52 TAS2783_CAL_R0LOW, 53 TAS2783_CAL_POWER, 54 TAS2783_CAL_TLIM, 55 }; 56 57 struct tas_fw_hdr { 58 u32 size; 59 u32 version_offset; 60 u32 plt_id; 61 u32 ppc3_ver; 62 u32 timestamp; 63 u8 ddc_name[64]; 64 }; 65 66 struct tas_fw_file { 67 u32 vendor_id; 68 u32 file_id; 69 u32 version; 70 u32 length; 71 u32 dest_addr; 72 u8 *fw_data; 73 }; 74 75 struct calibration_data { 76 u32 is_valid; 77 unsigned long read_sz; 78 u8 data[TAS2783_CALIB_DATA_SZ]; 79 }; 80 81 struct tas2783_prv { 82 struct snd_soc_component *component; 83 struct calibration_data cali_data; 84 struct sdw_slave *sdw_peripheral; 85 struct sdca_function_data *sa_func_data; 86 enum sdw_slave_status status; 87 /* calibration */ 88 struct mutex calib_lock; 89 /* pde and firmware download */ 90 struct mutex pde_lock; 91 struct regmap *regmap; 92 struct device *dev; 93 struct class *class; 94 struct attribute_group *cal_attr_groups; 95 struct tm tm; 96 u8 rca_binaryname[64]; 97 u8 dev_name[32]; 98 bool hw_init; 99 /* wq for firmware download */ 100 wait_queue_head_t fw_wait; 101 bool fw_dl_task_done; 102 bool fw_dl_success; 103 /* use fallback fw name */ 104 bool fw_use_fallback; 105 }; 106 107 static const struct reg_default tas2783_reg_default[] = { 108 {TAS2783_AMP_LEVEL, 0x28}, 109 {TASDEV_REG_SDW(0, 0, 0x03), 0x28}, 110 {TASDEV_REG_SDW(0, 0, 0x04), 0x21}, 111 {TASDEV_REG_SDW(0, 0, 0x05), 0x41}, 112 {TASDEV_REG_SDW(0, 0, 0x06), 0x00}, 113 {TASDEV_REG_SDW(0, 0, 0x07), 0x20}, 114 {TASDEV_REG_SDW(0, 0, 0x08), 0x09}, 115 {TASDEV_REG_SDW(0, 0, 0x09), 0x02}, 116 {TASDEV_REG_SDW(0, 0, 0x0a), 0x0a}, 117 {TASDEV_REG_SDW(0, 0, 0x0c), 0x10}, 118 {TASDEV_REG_SDW(0, 0, 0x0d), 0x13}, 119 {TASDEV_REG_SDW(0, 0, 0x0e), 0xc2}, 120 {TASDEV_REG_SDW(0, 0, 0x0f), 0x40}, 121 {TASDEV_REG_SDW(0, 0, 0x10), 0x04}, 122 {TASDEV_REG_SDW(0, 0, 0x13), 0x13}, 123 {TASDEV_REG_SDW(0, 0, 0x14), 0x12}, 124 {TASDEV_REG_SDW(0, 0, 0x15), 0x00}, 125 {TASDEV_REG_SDW(0, 0, 0x16), 0x12}, 126 {TASDEV_REG_SDW(0, 0, 0x17), 0x80}, 127 {TAS2783_DVC_LVL, 0x00}, 128 {TASDEV_REG_SDW(0, 0, 0x1b), 0x61}, 129 {TASDEV_REG_SDW(0, 0, 0x1c), 0x36}, 130 {TASDEV_REG_SDW(0, 0, 0x1d), 0x00}, 131 {TASDEV_REG_SDW(0, 0, 0x1f), 0x01}, 132 {TASDEV_REG_SDW(0, 0, 0x20), 0x2e}, 133 {TASDEV_REG_SDW(0, 0, 0x21), 0x00}, 134 {TASDEV_REG_SDW(0, 0, 0x34), 0x06}, 135 {TASDEV_REG_SDW(0, 0, 0x35), 0xbd}, 136 {TASDEV_REG_SDW(0, 0, 0x36), 0xad}, 137 {TASDEV_REG_SDW(0, 0, 0x37), 0xa8}, 138 {TASDEV_REG_SDW(0, 0, 0x38), 0x00}, 139 {TASDEV_REG_SDW(0, 0, 0x3b), 0xfc}, 140 {TASDEV_REG_SDW(0, 0, 0x3d), 0xdd}, 141 {TASDEV_REG_SDW(0, 0, 0x40), 0xf6}, 142 {TASDEV_REG_SDW(0, 0, 0x41), 0x14}, 143 {TASDEV_REG_SDW(0, 0, 0x5c), 0x19}, 144 {TASDEV_REG_SDW(0, 0, 0x5d), 0x80}, 145 {TASDEV_REG_SDW(0, 0, 0x63), 0x48}, 146 {TASDEV_REG_SDW(0, 0, 0x65), 0x08}, 147 {TASDEV_REG_SDW(0, 0, 0x66), 0xb2}, 148 {TASDEV_REG_SDW(0, 0, 0x67), 0x00}, 149 {TASDEV_REG_SDW(0, 0, 0x6a), 0x12}, 150 {TASDEV_REG_SDW(0, 0, 0x6b), 0xfb}, 151 {TASDEV_REG_SDW(0, 0, 0x6c), 0x00}, 152 {TASDEV_REG_SDW(0, 0, 0x6d), 0x00}, 153 {TASDEV_REG_SDW(0, 0, 0x6e), 0x1a}, 154 {TASDEV_REG_SDW(0, 0, 0x6f), 0x00}, 155 {TASDEV_REG_SDW(0, 0, 0x70), 0x96}, 156 {TASDEV_REG_SDW(0, 0, 0x71), 0x02}, 157 {TASDEV_REG_SDW(0, 0, 0x73), 0x08}, 158 {TASDEV_REG_SDW(0, 0, 0x75), 0xe0}, 159 {TASDEV_REG_SDW(0, 0, 0x7a), 0x60}, 160 {TASDEV_REG_SDW(0, 0, 0x60), 0x21}, 161 {TASDEV_REG_SDW(0, 1, 0x02), 0x00}, 162 {TASDEV_REG_SDW(0, 1, 0x17), 0xc0}, 163 {TASDEV_REG_SDW(0, 1, 0x19), 0x60}, 164 {TASDEV_REG_SDW(0, 1, 0x35), 0x75}, 165 {TASDEV_REG_SDW(0, 1, 0x3d), 0x00}, 166 {TASDEV_REG_SDW(0, 1, 0x3e), 0x00}, 167 {TASDEV_REG_SDW(0, 1, 0x3f), 0x00}, 168 {TASDEV_REG_SDW(0, 1, 0x40), 0x00}, 169 {TASDEV_REG_SDW(0, 1, 0x41), 0x00}, 170 {TASDEV_REG_SDW(0, 1, 0x42), 0x00}, 171 {TASDEV_REG_SDW(0, 1, 0x43), 0x00}, 172 {TASDEV_REG_SDW(0, 1, 0x44), 0x00}, 173 {TASDEV_REG_SDW(0, 1, 0x45), 0x00}, 174 {TASDEV_REG_SDW(0, 1, 0x47), 0xab}, 175 {TASDEV_REG_SDW(0, 0xfd, 0x0d), 0x0d}, 176 {TASDEV_REG_SDW(0, 0xfd, 0x39), 0x00}, 177 {TASDEV_REG_SDW(0, 0xfd, 0x3e), 0x00}, 178 {TASDEV_REG_SDW(0, 0xfd, 0x45), 0x00}, 179 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_CS21, 0x02, 0), 0x0}, 180 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_CS21, 0x10, 0), 0x0}, 181 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_CS24, 0x02, 0), 0x0}, 182 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_CS24, 0x10, 0), 0x0}, 183 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_CS26, 0x02, 0), 0x0}, 184 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_CS26, 0x10, 0), 0x0}, 185 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_CS28, 0x02, 0), 0x0}, 186 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_CS28, 0x10, 0), 0x0}, 187 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_CS127, 0x02, 0), 0x0}, 188 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_CS127, 0x10, 0), 0x0}, 189 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_FU21, 0x01, 1), 0x1}, 190 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_FU21, 0x02, 1), 0x9c00}, 191 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_FU23, 0x01, 0), 0x1}, 192 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_FU23, 0x01, 1), 0x1}, 193 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_FU23, 0x0b, 1), 0x0}, 194 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_FU23, 0x10, 0), 0x0}, 195 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_FU26, 0x01, 1), 0x1}, 196 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_FU26, 0x01, 0), 0x1}, 197 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_FU26, 0x0b, 1), 0x0}, 198 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_FU26, 0x10, 0), 0x0}, 199 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_FU127, 0x01, 0), 0x1}, 200 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_FU127, 0x01, 1), 0x1}, 201 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_FU127, 0x01, 2), 0x1}, 202 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_FU127, 0x0b, 0), 0x0}, 203 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_FU127, 0x0b, 1), 0x0}, 204 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_FU127, 0x0b, 2), 0x0}, 205 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_FU127, 0x10, 0), 0x0}, 206 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_IT21, 0x04, 0), 0x0}, 207 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_IT21, 0x08, 0), 0x0}, 208 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_IT21, 0x10, 0), 0x0}, 209 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_IT21, 0x11, 0), 0x0}, 210 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_IT26, 0x04, 0), 0x0}, 211 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_IT26, 0x08, 0), 0x0}, 212 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_IT26, 0x10, 0), 0x0}, 213 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_IT26, 0x11, 0), 0x0}, 214 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_IT28, 0x04, 0), 0x0}, 215 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_IT28, 0x08, 0), 0x0}, 216 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_IT28, 0x10, 0), 0x0}, 217 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_IT28, 0x11, 0), 0x0}, 218 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_IT29, 0x04, 0), 0x0}, 219 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_IT29, 0x08, 0), 0x0}, 220 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_IT29, 0x10, 0), 0x0}, 221 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_IT29, 0x11, 0), 0x0}, 222 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_MFPU21, 0x01, 0), 0x0}, 223 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_MFPU21, 0x04, 0), 0x0}, 224 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_MFPU21, 0x05, 0), 0x1}, 225 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_MFPU21, 0x08, 0), 0x0}, 226 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_MFPU21, 0x10, 0), 0x0}, 227 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_MFPU21, 0x11, 0), 0x0}, 228 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_MFPU21, 0x12, 0), 0x0}, 229 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_MFPU26, 0x01, 0), 0x0}, 230 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_MFPU26, 0x04, 0), 0x0}, 231 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_MFPU26, 0x05, 0), 0x1}, 232 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_MFPU26, 0x08, 0), 0x0}, 233 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_MFPU26, 0x10, 0), 0x0}, 234 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_MFPU26, 0x11, 0), 0x0}, 235 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_MFPU26, 0x12, 0), 0x0}, 236 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_MU26, 0x01, 0), 0x0}, 237 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_MU26, 0x01, 1), 0x0}, 238 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_MU26, 0x01, 2), 0x0}, 239 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_MU26, 0x01, 3), 0x0}, 240 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_MU26, 0x01, 4), 0x0}, 241 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_MU26, 0x01, 5), 0x0}, 242 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_MU26, 0x01, 6), 0x0}, 243 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_MU26, 0x01, 7), 0x0}, 244 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_MU26, 0x06, 0), 0x0}, 245 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_OT23, 0x04, 0), 0x0}, 246 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_OT23, 0x08, 0), 0x0}, 247 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_OT24, 0x04, 0), 0x0}, 248 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_OT24, 0x08, 0), 0x0}, 249 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_OT24, 0x11, 0), 0x0}, 250 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_OT25, 0x04, 0), 0x0}, 251 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_OT25, 0x08, 0), 0x0}, 252 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_OT25, 0x11, 0), 0x0}, 253 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_OT28, 0x04, 0), 0x0}, 254 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_OT28, 0x08, 0), 0x0}, 255 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_OT28, 0x11, 0), 0x0}, 256 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_OT127, 0x04, 0), 0x0}, 257 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_OT127, 0x08, 0), 0x0}, 258 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_OT127, 0x11, 0), 0x0}, 259 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_OT127, 0x12, 0), 0x0}, 260 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_OT127, 0x12, 1), 0x0}, 261 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_OT127, 0x12, 2), 0x0}, 262 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_OT127, 0x12, 3), 0x0}, 263 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_OT127, 0x12, 4), 0x0}, 264 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_OT127, 0x12, 5), 0x0}, 265 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_OT127, 0x12, 6), 0x0}, 266 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_OT127, 0x12, 7), 0x0}, 267 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_OT127, 0x12, 8), 0x0}, 268 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_OT127, 0x12, 9), 0x0}, 269 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_OT127, 0x12, 0xa), 0x0}, 270 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_OT127, 0x12, 0xb), 0x0}, 271 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_OT127, 0x12, 0xc), 0x0}, 272 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_OT127, 0x12, 0xd), 0x0}, 273 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_OT127, 0x12, 0xe), 0x0}, 274 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_OT127, 0x12, 0xf), 0x0}, 275 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_PDE23, 0x1, 0), 0x3}, 276 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_PDE23, 0x10, 0), 0x3}, 277 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_PPU21, 0x06, 0), 0x0}, 278 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_PPU21, 0x10, 0), 0x0}, 279 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_PPU21, 0x11, 0), 0x0}, 280 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_PPU21, 0x12, 0), 0x0}, 281 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_PPU21, 0x13, 0), 0x0}, 282 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_PPU26, 0x06, 0), 0x0}, 283 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_PPU26, 0x10, 0), 0x0}, 284 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_PPU26, 0x11, 0), 0x0}, 285 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_PPU26, 0x12, 0), 0x0}, 286 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_PPU26, 0x13, 0), 0x0}, 287 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_SAPU29, 0x05, 0), 0x0}, 288 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_SAPU29, 0x10, 0), 0x1}, 289 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_SAPU29, 0x11, 0), 0x0}, 290 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_SAPU29, 0x12, 0), 0x0}, 291 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_TG23, 0x10, 0), 0x0}, 292 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_XU22, 0x01, 0), 0x1}, 293 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_XU22, 0x06, 0), 0x0}, 294 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_XU22, 0x07, 0), 0x0}, 295 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_XU22, 0x08, 0), 0x0}, 296 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_XU22, 0x09, 0), 0x0}, 297 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_XU22, 0x0a, 0), 0x0}, 298 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_XU22, 0x10, 0), 0x1}, 299 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_XU22, 0x12, 0), 0x0}, 300 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_XU22, 0x13, 0), 0x0}, 301 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_XU22, 0x14, 0), 0x0}, 302 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_XU22, 0x15, 0), 0x0}, 303 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_XU22, 0x16, 0), 0x0}, 304 {SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_UDMPU23, 0x10, 0), 0x0}, 305 }; 306 307 static const struct reg_sequence tas2783_init_seq[] = { 308 REG_SEQ0(SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_PPU21, 0x10, 0x00), 0x01), 309 REG_SEQ0(0x00800418, 0x00), 310 REG_SEQ0(0x00800419, 0x00), 311 REG_SEQ0(0x0080041a, 0x00), 312 REG_SEQ0(0x0080041b, 0x00), 313 REG_SEQ0(0x00800428, 0x40), 314 REG_SEQ0(0x00800429, 0x00), 315 REG_SEQ0(0x0080042a, 0x00), 316 REG_SEQ0(0x0080042b, 0x00), 317 REG_SEQ0(SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_FU23, 0x1, 0x00), 0x00), 318 REG_SEQ0(0x00800004, 0x21), 319 REG_SEQ0(0x00800005, 0x41), 320 REG_SEQ0(0x00800006, 0x00), 321 REG_SEQ0(0x00800007, 0x20), 322 REG_SEQ0(0x00800015, 0x00), 323 REG_SEQ0(0x00800036, 0xad), 324 REG_SEQ0(0x00800037, 0xa8), 325 REG_SEQ0(0x0080006b, 0x7b), 326 REG_SEQ0(0x0080006c, 0x00), 327 REG_SEQ0(0x0080006d, 0x00), 328 REG_SEQ0(0x0080006e, 0x1a), 329 REG_SEQ0(0x0080006f, 0x00), 330 REG_SEQ0(0x00800071, 0x02), 331 REG_SEQ0(0x008000be, 0x00), 332 REG_SEQ0(0x008000bf, 0x00), 333 REG_SEQ0(0x008000c0, 0x00), 334 REG_SEQ0(0x008000c1, 0x00), 335 REG_SEQ0(0x008000c2, 0x00), 336 REG_SEQ0(0x008000c3, 0x00), 337 REG_SEQ0(0x008000c4, 0x00), 338 }; 339 340 static int tas2783_sdca_mbq_size(struct device *dev, u32 reg) 341 { 342 switch (reg) { 343 case 0x000 ... 0x080: /* Data port 0. */ 344 case 0x100 ... 0x140: /* Data port 1. */ 345 case 0x200 ... 0x240: /* Data port 2. */ 346 case 0x300 ... 0x340: /* Data port 3. */ 347 case 0x400 ... 0x440: /* Data port 4. */ 348 case 0x500 ... 0x540: /* Data port 5. */ 349 case 0x800000 ... 0x803fff: /* Page 0 ~ 127. */ 350 case 0x807e80 ... 0x807eff: /* Page 253. */ 351 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_UDMPU23, 352 TAS2783_SDCA_CTL_UDMPU_CLUSTER, 0): 353 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_FU21, TAS2783_SDCA_CTL_FU_MUTE, 354 TAS2783_DEVICE_CHANNEL_LEFT): 355 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_PDE23, 0x1, 0): 356 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_PDE23, 0x10, 0): 357 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_IT21, 0x04, 0): 358 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_SAPU29, 0x10, 0): 359 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_SAPU29, 0x11, 0): 360 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_SAPU29, 0x12, 0): 361 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_PPU21, 0x10, 0): 362 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_PPU21, 0x11, 0): 363 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_PPU26, 0x10, 0): 364 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_PPU26, 0x11, 0): 365 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_TG23, 0x10, 0): 366 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_XU22, 0x01, 0): 367 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_XU22, 0x08, 0): 368 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_XU22, 0x0a, 0): 369 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_XU22, 0x10, 0): 370 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_XU22, 0x14, 0): 371 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_XU22, 0x15, 0): 372 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_XU22, 0x16, 0): 373 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_IT26, 0x04, 0): 374 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_IT28, 0x04, 0): 375 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_IT29, 0x04, 0): 376 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_OT23, 0x04, 0): 377 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_OT24, 0x04, 0): 378 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_OT28, 0x04, 0): 379 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_OT127, 0x04, 0): 380 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_OT127, 0x12, 0): 381 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_OT127, 0x12, 1): 382 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_OT127, 0x12, 2): 383 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_OT127, 0x12, 3): 384 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_OT127, 0x12, 4): 385 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_OT127, 0x12, 5): 386 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_OT127, 0x12, 6): 387 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_OT127, 0x12, 7): 388 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_OT127, 0x12, 8): 389 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_OT127, 0x12, 9): 390 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_OT127, 0x12, 0xa): 391 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_OT127, 0x12, 0xb): 392 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_OT127, 0x12, 0xc): 393 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_OT127, 0x12, 0xd): 394 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_OT127, 0x12, 0xe): 395 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_OT127, 0x12, 0xf): 396 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_CS21, 0x02, 0): 397 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_CS21, 0x10, 0): 398 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_CS24, 0x02, 0): 399 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_CS24, 0x10, 0): 400 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_CS25, 0x02, 0): 401 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_CS25, 0x10, 0): 402 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_CS127, 0x02, 0): 403 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_CS127, 0x10, 0): 404 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_CS26, 0x02, 0): 405 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_CS26, 0x10, 0): 406 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_CS28, 0x02, 0): 407 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_CS28, 0x10, 0): 408 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_MFPU21, 0x01, 0): 409 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_MFPU21, 0x04, 0): 410 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_MFPU21, 0x05, 0): 411 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_MFPU21, 0x10, 0): 412 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_MFPU21, 0x11, 0): 413 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_FU127, 0x01, 1): 414 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_FU127, 0x01, 2): 415 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_FU127, 0x01, 0): 416 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_FU26, 0x01, 1): 417 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_FU26, 0x01, 0): 418 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_MFPU26, 0x01, 0): 419 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_MFPU26, 0x04, 0): 420 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_MFPU26, 0x05, 0): 421 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_MFPU26, 0x10, 0): 422 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_MFPU26, 0x11, 0): 423 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_FU23, 0x01, 0): 424 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_FU23, 0x01, 1): 425 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_OT25, 0x04, 0): 426 return 1; 427 428 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_IT26, 0x10, 0): 429 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_IT26, 0x11, 0): 430 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_IT28, 0x10, 0): 431 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_IT28, 0x11, 0): 432 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_IT29, 0x10, 0): 433 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_IT29, 0x11, 0): 434 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_OT24, 0x11, 0): 435 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_OT25, 0x11, 0): 436 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_OT28, 0x11, 0): 437 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_OT127, 0x11, 0): 438 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_MU26, 0x01, 0): 439 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_MU26, 0x01, 1): 440 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_MU26, 0x01, 2): 441 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_MU26, 0x01, 3): 442 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_MU26, 0x01, 4): 443 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_MU26, 0x01, 5): 444 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_MU26, 0x01, 6): 445 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_MU26, 0x01, 7): 446 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_FU21, 0x02, 1): 447 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_FU23, 0x0b, 1): 448 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_FU127, 0x0b, 1): 449 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_FU127, 0x0b, 2): 450 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_FU127, 0x0b, 0): 451 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_FU26, 0x0b, 0): 452 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_FU26, 0x0b, 1): 453 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_XU22, 0x07, 0): 454 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_XU22, 0x09, 0): 455 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_MFPU21, 0x12, 0): 456 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_MFPU26, 0x12, 0): 457 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_PPU21, 0x12, 0): 458 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_PPU21, 0x13, 0): 459 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_PPU26, 0x12, 0): 460 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_PPU26, 0x13, 0): 461 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_IT21, 0x10, 0): 462 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_IT21, 0x11, 0): 463 return 2; 464 465 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_FU23, 0x10, 0): 466 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_IT21, 0x08, 0): 467 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_IT26, 0x08, 0): 468 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_IT28, 0x08, 0): 469 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_IT29, 0x08, 0): 470 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_OT23, 0x08, 0): 471 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_OT24, 0x08, 0): 472 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_OT25, 0x08, 0): 473 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_OT28, 0x08, 0): 474 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_OT127, 0x08, 0): 475 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_MU26, 0x06, 0): 476 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_FU127, 0x10, 0): 477 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_FU26, 0x10, 0): 478 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_XU22, 0x06, 0): 479 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_XU22, 0x12, 0): 480 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_XU22, 0x13, 0): 481 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_MFPU21, 0x08, 0): 482 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_MFPU26, 0x08, 0): 483 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_SAPU29, 0x05, 0): 484 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_PPU21, 0x06, 0): 485 case SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_PPU26, 0x06, 0): 486 return 4; 487 488 default: 489 return 0; 490 } 491 } 492 493 static bool tas2783_readable_register(struct device *dev, unsigned int reg) 494 { 495 return tas2783_sdca_mbq_size(dev, reg) > 0; 496 } 497 498 static bool tas2783_volatile_register(struct device *dev, u32 reg) 499 { 500 switch (reg) { 501 case 0x000 ... 0x080: /* Data port 0. */ 502 case 0x100 ... 0x140: /* Data port 1. */ 503 case 0x200 ... 0x240: /* Data port 2. */ 504 case 0x300 ... 0x340: /* Data port 3. */ 505 case 0x400 ... 0x440: /* Data port 4. */ 506 case 0x500 ... 0x540: /* Data port 5. */ 507 case 0x800001: 508 return true; 509 510 default: 511 return false; 512 } 513 } 514 515 static const struct regmap_config tas_regmap = { 516 .reg_bits = 32, 517 .val_bits = 8, 518 .readable_reg = tas2783_readable_register, 519 .volatile_reg = tas2783_volatile_register, 520 .reg_defaults = tas2783_reg_default, 521 .num_reg_defaults = ARRAY_SIZE(tas2783_reg_default), 522 .max_register = 0x41008000 + TASDEV_REG_SDW(0xa1, 0x60, 0x7f), 523 .cache_type = REGCACHE_MAPLE, 524 .use_single_read = true, 525 .use_single_write = true, 526 }; 527 528 static const struct regmap_sdw_mbq_cfg tas2783_mbq_cfg = { 529 .mbq_size = tas2783_sdca_mbq_size, 530 }; 531 532 static s32 tas2783_digital_getvol(struct snd_kcontrol *kcontrol, 533 struct snd_ctl_elem_value *ucontrol) 534 { 535 return snd_soc_get_volsw(kcontrol, ucontrol); 536 } 537 538 static s32 tas2783_digital_putvol(struct snd_kcontrol *kcontrol, 539 struct snd_ctl_elem_value *ucontrol) 540 { 541 return snd_soc_put_volsw(kcontrol, ucontrol); 542 } 543 544 static s32 tas2783_amp_getvol(struct snd_kcontrol *kcontrol, 545 struct snd_ctl_elem_value *ucontrol) 546 { 547 return snd_soc_get_volsw(kcontrol, ucontrol); 548 } 549 550 static s32 tas2783_amp_putvol(struct snd_kcontrol *kcontrol, 551 struct snd_ctl_elem_value *ucontrol) 552 { 553 return snd_soc_put_volsw(kcontrol, ucontrol); 554 } 555 556 static const struct snd_kcontrol_new tas2783_snd_controls[] = { 557 SOC_SINGLE_RANGE_EXT_TLV("Amp Volume", TAS2783_AMP_LEVEL, 558 1, 0, 20, 0, tas2783_amp_getvol, 559 tas2783_amp_putvol, tas2781_amp_tlv), 560 SOC_SINGLE_RANGE_EXT_TLV("Speaker Volume", TAS2783_DVC_LVL, 561 0, 0, 200, 1, tas2783_digital_getvol, 562 tas2783_digital_putvol, tas2781_dvc_tlv), 563 }; 564 565 static s32 tas2783_validate_calibdata(struct tas2783_prv *tas_dev, 566 u8 *data, u32 size) 567 { 568 u32 ts, spk_count, size_calculated; 569 u32 crc_calculated, crc_read, i; 570 u32 *tmp_val; 571 struct tm tm; 572 573 i = 0; 574 tmp_val = (u32 *)data; 575 if (tmp_val[i++] != 2783) { 576 dev_err(tas_dev->dev, "cal data magic number mismatch"); 577 return -EINVAL; 578 } 579 580 spk_count = tmp_val[i++]; 581 if (spk_count > TAS2783_CALIB_MAX_SPK_COUNT) { 582 dev_err(tas_dev->dev, "cal data spk_count too large"); 583 return -EINVAL; 584 } 585 586 ts = tmp_val[i++]; 587 time64_to_tm(ts, 0, &tm); 588 dev_dbg(tas_dev->dev, "cal data timestamp: %ld-%d-%d %d:%d:%d", 589 tm.tm_year + 1900, tm.tm_mon + 1, tm.tm_mday, 590 tm.tm_hour, tm.tm_min, tm.tm_sec); 591 592 size_calculated = 593 (spk_count * TAS2783_CALIB_PARAMS * sizeof(u32)) + 594 TAS2783_CALIB_HDR_SZ + TAS2783_CALIB_CRC_SZ; 595 if (size_calculated > TAS2783_CALIB_DATA_SZ) { 596 dev_err(tas_dev->dev, "cali data sz too large"); 597 return -EINVAL; 598 } else if (size < size_calculated) { 599 dev_err(tas_dev->dev, "cali data size mismatch calc=%u vs %d\n", 600 size, size_calculated); 601 return -EINVAL; 602 } 603 604 crc_calculated = crc32(~0, data, 605 size_calculated - TAS2783_CALIB_CRC_SZ) ^ ~0; 606 crc_read = tmp_val[(size_calculated - TAS2783_CALIB_CRC_SZ) / sizeof(u32)]; 607 if (crc_calculated != crc_read) { 608 dev_err(tas_dev->dev, 609 "calib data integrity check fail, 0x%08x vs 0x%08x\n", 610 crc_calculated, crc_read); 611 return -EINVAL; 612 } 613 614 return 0; 615 } 616 617 static void tas2783_set_calib_params_to_device(struct tas2783_prv *tas_dev, u32 *cali_data) 618 { 619 u32 dev_count, offset, i, device_num; 620 u32 reg_value; 621 u8 buf[4]; 622 623 dev_count = cali_data[1]; 624 offset = 3; 625 626 for (device_num = 0; device_num < dev_count; device_num++) { 627 if (cali_data[offset] != tas_dev->sdw_peripheral->id.unique_id) { 628 offset += TAS2783_CALIB_PARAMS; 629 continue; 630 } 631 offset++; 632 633 for (i = 0; i < ARRAY_SIZE(tas2783_cali_reg); i++) { 634 reg_value = cali_data[offset + i]; 635 buf[0] = reg_value >> 24; 636 buf[1] = reg_value >> 16; 637 buf[2] = reg_value >> 8; 638 buf[3] = reg_value & 0xff; 639 regmap_bulk_write(tas_dev->regmap, tas2783_cali_reg[i], 640 buf, sizeof(u32)); 641 } 642 break; 643 } 644 645 if (device_num == dev_count) 646 dev_err(tas_dev->dev, 647 "unique id not found in the calib data\n"); 648 else 649 dev_dbg(tas_dev->dev, "calib data update done\n"); 650 } 651 652 static s32 tas2783_update_calibdata(struct tas2783_prv *tas_dev) 653 { 654 efi_guid_t efi_guid = TAS2783_CALI_GUID; 655 u32 attr, i, *tmp_val; 656 unsigned long size; 657 s32 ret; 658 efi_status_t status; 659 static efi_char16_t efi_names[][32] = { 660 L"SmartAmpCalibrationData", L"CALI_DATA"}; 661 662 tmp_val = (u32 *)tas_dev->cali_data.data; 663 attr = 0; 664 665 /* 666 * In some cases, the calibration is performed in Windows, 667 * and data was saved in UEFI. Linux can access it. 668 */ 669 for (i = 0; i < ARRAY_SIZE(efi_names); i++) { 670 size = 0; 671 status = efi.get_variable(efi_names[i], &efi_guid, &attr, 672 &size, NULL); 673 if (size > TAS2783_CALIB_DATA_SZ) { 674 dev_err(tas_dev->dev, "cali data too large\n"); 675 break; 676 } 677 678 tas_dev->cali_data.read_sz = size; 679 if (status == EFI_BUFFER_TOO_SMALL) { 680 status = efi.get_variable(efi_names[i], &efi_guid, &attr, 681 &tas_dev->cali_data.read_sz, 682 tas_dev->cali_data.data); 683 dev_dbg(tas_dev->dev, "cali get %lu bytes result:%ld\n", 684 tas_dev->cali_data.read_sz, status); 685 } 686 if (status == EFI_SUCCESS) 687 break; 688 } 689 690 if (status != EFI_SUCCESS) { 691 /* Failed got calibration data from EFI. */ 692 dev_dbg(tas_dev->dev, "No calibration data in UEFI."); 693 return 0; 694 } 695 696 mutex_lock(&tas_dev->calib_lock); 697 ret = tas2783_validate_calibdata(tas_dev, tas_dev->cali_data.data, 698 tas_dev->cali_data.read_sz); 699 if (!ret) 700 tas2783_set_calib_params_to_device(tas_dev, tmp_val); 701 mutex_unlock(&tas_dev->calib_lock); 702 703 return ret; 704 } 705 706 static s32 tas_fw_read_hdr(const u8 *data, struct tas_fw_hdr *hdr) 707 { 708 hdr->size = get_unaligned_le32(data); 709 hdr->version_offset = get_unaligned_le32(&data[4]); 710 hdr->plt_id = get_unaligned_le32(&data[8]); 711 hdr->ppc3_ver = get_unaligned_le32(&data[12]); 712 memcpy(hdr->ddc_name, &data[16], 64); 713 hdr->timestamp = get_unaligned_le32(&data[80]); 714 715 return 84; 716 } 717 718 static s32 tas_fw_get_next_file(const u8 *data, struct tas_fw_file *file) 719 { 720 file->vendor_id = get_unaligned_le32(&data[0]); 721 file->file_id = get_unaligned_le32(&data[4]); 722 file->version = get_unaligned_le32(&data[8]); 723 file->length = get_unaligned_le32(&data[12]); 724 file->dest_addr = get_unaligned_le32(&data[16]); 725 file->fw_data = (u8 *)&data[20]; 726 727 return file->length + sizeof(u32) * 5; 728 } 729 730 static void tas2783_fw_ready(const struct firmware *fmw, void *context) 731 { 732 struct tas2783_prv *tas_dev = 733 (struct tas2783_prv *)context; 734 const u8 *buf = NULL; 735 s32 img_sz, ret = 0, cur_file = 0; 736 s32 offset = 0; 737 738 struct tas_fw_hdr *hdr __free(kfree) = kzalloc_obj(*hdr); 739 struct tas_fw_file *file __free(kfree) = kzalloc_obj(*file); 740 if (!file || !hdr) { 741 ret = -ENOMEM; 742 goto out; 743 } 744 745 /* firmware binary not found*/ 746 if (!fmw || !fmw->data) { 747 if (!tas_dev->fw_use_fallback) { 748 tas_dev->fw_use_fallback = true; 749 dev_info(tas_dev->dev, 750 "Failed to read preferred fw binary: %s, attempting fallback binary load\n", 751 tas_dev->rca_binaryname); 752 } else { 753 dev_err(tas_dev->dev, 754 "Failed to read fallback fw binary %s\n", 755 tas_dev->rca_binaryname); 756 } 757 758 ret = -EINVAL; 759 goto out; 760 } 761 762 img_sz = fmw->size; 763 buf = fmw->data; 764 offset += tas_fw_read_hdr(buf, hdr); 765 if (hdr->size != img_sz) { 766 ret = -EINVAL; 767 dev_err(tas_dev->dev, "firmware size mismatch with header"); 768 goto out; 769 } 770 771 if (img_sz < FW_DL_OFFSET) { 772 ret = -EINVAL; 773 dev_err(tas_dev->dev, "unexpected size, size is too small"); 774 goto out; 775 } 776 777 mutex_lock(&tas_dev->pde_lock); 778 while (offset < (img_sz - FW_FL_HDR)) { 779 offset += tas_fw_get_next_file(&buf[offset], file); 780 dev_dbg(tas_dev->dev, 781 "v=%d, fid=%d, ver=%d, len=%d, daddr=0x%x, fw=%p", 782 file->vendor_id, file->file_id, 783 file->version, file->length, 784 file->dest_addr, file->fw_data); 785 786 ret = sdw_nwrite_no_pm(tas_dev->sdw_peripheral, 787 file->dest_addr, 788 file->length, 789 file->fw_data); 790 if (ret < 0) { 791 dev_err(tas_dev->dev, 792 "FW download failed: %d", ret); 793 break; 794 } 795 cur_file++; 796 } 797 mutex_unlock(&tas_dev->pde_lock); 798 799 if (cur_file == 0) { 800 dev_err(tas_dev->dev, "fw with no files"); 801 ret = -EINVAL; 802 } else { 803 tas2783_update_calibdata(tas_dev); 804 } 805 806 out: 807 if (!ret) 808 tas_dev->fw_dl_success = true; 809 tas_dev->fw_dl_task_done = true; 810 wake_up(&tas_dev->fw_wait); 811 if (fmw) 812 release_firmware(fmw); 813 } 814 815 static inline s32 tas_clear_latch(struct tas2783_prv *priv) 816 { 817 return regmap_update_bits(priv->regmap, 818 TASDEV_REG_SDW(0, 0, 0x5c), 819 0x04, 0x04); 820 } 821 822 static s32 tas_fu21_event(struct snd_soc_dapm_widget *w, 823 struct snd_kcontrol *k, s32 event) 824 { 825 struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm); 826 struct tas2783_prv *tas_dev = snd_soc_component_get_drvdata(component); 827 s32 mute; 828 829 switch (event) { 830 case SND_SOC_DAPM_POST_PMU: 831 mute = 0; 832 break; 833 834 case SND_SOC_DAPM_PRE_PMD: 835 mute = 1; 836 break; 837 } 838 839 return sdw_write_no_pm(tas_dev->sdw_peripheral, 840 SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_FU21, 841 TAS2783_SDCA_CTL_FU_MUTE, 1), mute); 842 } 843 844 static s32 tas_fu23_event(struct snd_soc_dapm_widget *w, 845 struct snd_kcontrol *k, s32 event) 846 { 847 struct snd_soc_component *component = snd_soc_dapm_to_component(w->dapm); 848 struct tas2783_prv *tas_dev = snd_soc_component_get_drvdata(component); 849 s32 mute; 850 851 switch (event) { 852 case SND_SOC_DAPM_POST_PMU: 853 mute = 0; 854 break; 855 856 case SND_SOC_DAPM_PRE_PMD: 857 mute = 1; 858 break; 859 } 860 861 return sdw_write_no_pm(tas_dev->sdw_peripheral, 862 SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_FU23, 863 TAS2783_SDCA_CTL_FU_MUTE, 1), mute); 864 } 865 866 static const struct snd_soc_dapm_widget tas_dapm_widgets[] = { 867 SND_SOC_DAPM_AIF_IN("ASI", "ASI Playback", 0, SND_SOC_NOPM, 0, 0), 868 SND_SOC_DAPM_AIF_OUT("ASI OUT", "ASI Capture", 0, SND_SOC_NOPM, 869 0, 0), 870 SND_SOC_DAPM_DAC_E("FU21", NULL, SND_SOC_NOPM, 0, 0, tas_fu21_event, 871 SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_PRE_PMD), 872 SND_SOC_DAPM_DAC_E("FU23", NULL, SND_SOC_NOPM, 0, 0, tas_fu23_event, 873 SND_SOC_DAPM_POST_PMU | SND_SOC_DAPM_PRE_PMD), 874 SND_SOC_DAPM_OUTPUT("SPK"), 875 SND_SOC_DAPM_INPUT("DMIC"), 876 }; 877 878 static const struct snd_soc_dapm_route tas_audio_map[] = { 879 {"FU21", NULL, "ASI"}, 880 {"SPK", NULL, "FU21"}, 881 {"FU23", NULL, "ASI"}, 882 {"SPK", NULL, "FU23"}, 883 {"ASI OUT", NULL, "DMIC"}, 884 }; 885 886 static s32 tas_set_sdw_stream(struct snd_soc_dai *dai, 887 void *sdw_stream, s32 direction) 888 { 889 if (!sdw_stream) 890 return 0; 891 892 snd_soc_dai_dma_data_set(dai, direction, sdw_stream); 893 894 return 0; 895 } 896 897 static void tas_sdw_shutdown(struct snd_pcm_substream *substream, 898 struct snd_soc_dai *dai) 899 { 900 snd_soc_dai_set_dma_data(dai, substream, NULL); 901 } 902 903 static s32 tas_sdw_hw_params(struct snd_pcm_substream *substream, 904 struct snd_pcm_hw_params *params, 905 struct snd_soc_dai *dai) 906 { 907 struct snd_soc_component *component = dai->component; 908 struct tas2783_prv *tas_dev = 909 snd_soc_component_get_drvdata(component); 910 struct sdw_stream_config stream_config = {0}; 911 struct sdw_port_config port_config = {0}; 912 struct sdw_stream_runtime *sdw_stream; 913 struct sdw_slave *sdw_peripheral = tas_dev->sdw_peripheral; 914 s32 ret, retry = 3; 915 916 if (!tas_dev->fw_dl_success) { 917 dev_err(tas_dev->dev, "error playback without fw download"); 918 return -EINVAL; 919 } 920 921 sdw_stream = snd_soc_dai_get_dma_data(dai, substream); 922 if (!sdw_stream) 923 return -EINVAL; 924 925 ret = tas_clear_latch(tas_dev); 926 if (ret) 927 dev_err(tas_dev->dev, 928 "clear latch failed, err=%d", ret); 929 930 mutex_lock(&tas_dev->pde_lock); 931 /* 932 * Sometimes, there is error returned during power on. 933 * So added retry logic to ensure power on so that 934 * port prepare succeeds 935 */ 936 do { 937 ret = regmap_write(tas_dev->regmap, 938 SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_PDE23, 939 TAS2783_SDCA_CTL_REQ_POW_STATE, 0), 940 TAS2783_SDCA_POW_STATE_ON); 941 if (!ret) 942 break; 943 usleep_range(2000, 2200); 944 } while (retry--); 945 mutex_unlock(&tas_dev->pde_lock); 946 if (ret) 947 return ret; 948 949 /* SoundWire specific configuration */ 950 snd_sdw_params_to_config(substream, params, 951 &stream_config, &port_config); 952 /* port 1 for playback */ 953 if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK) 954 port_config.num = 1; 955 else 956 port_config.num = 2; 957 958 ret = sdw_stream_add_slave(sdw_peripheral, 959 &stream_config, &port_config, 1, sdw_stream); 960 if (ret) 961 dev_err(dai->dev, "Unable to configure port\n"); 962 963 return ret; 964 } 965 966 static s32 tas_sdw_pcm_hw_free(struct snd_pcm_substream *substream, 967 struct snd_soc_dai *dai) 968 { 969 s32 ret; 970 struct snd_soc_component *component = dai->component; 971 struct tas2783_prv *tas_dev = 972 snd_soc_component_get_drvdata(component); 973 struct sdw_stream_runtime *sdw_stream = 974 snd_soc_dai_get_dma_data(dai, substream); 975 976 sdw_stream_remove_slave(tas_dev->sdw_peripheral, sdw_stream); 977 978 mutex_lock(&tas_dev->pde_lock); 979 ret = regmap_write(tas_dev->regmap, 980 SDW_SDCA_CTL(1, TAS2783_SDCA_ENT_PDE23, 981 TAS2783_SDCA_CTL_REQ_POW_STATE, 0), 982 TAS2783_SDCA_POW_STATE_OFF); 983 mutex_unlock(&tas_dev->pde_lock); 984 985 return ret; 986 } 987 988 static const struct snd_soc_dai_ops tas_dai_ops = { 989 .hw_params = tas_sdw_hw_params, 990 .hw_free = tas_sdw_pcm_hw_free, 991 .set_stream = tas_set_sdw_stream, 992 .shutdown = tas_sdw_shutdown, 993 }; 994 995 static struct snd_soc_dai_driver tas_dai_driver[] = { 996 { 997 .name = "tas2783-codec", 998 .id = 0, 999 .playback = { 1000 .stream_name = "Playback", 1001 .channels_min = 1, 1002 .channels_max = 4, 1003 .rates = TAS2783_DEVICE_RATES, 1004 .formats = TAS2783_DEVICE_FORMATS, 1005 }, 1006 .capture = { 1007 .stream_name = "Capture", 1008 .channels_min = 1, 1009 .channels_max = 4, 1010 .rates = TAS2783_DEVICE_RATES, 1011 .formats = TAS2783_DEVICE_FORMATS, 1012 }, 1013 .ops = &tas_dai_ops, 1014 .symmetric_rate = 1, 1015 }, 1016 }; 1017 1018 static s32 tas_component_probe(struct snd_soc_component *component) 1019 { 1020 struct tas2783_prv *tas_dev = 1021 snd_soc_component_get_drvdata(component); 1022 1023 tas_dev->component = component; 1024 1025 return 0; 1026 } 1027 1028 static void tas_component_remove(struct snd_soc_component *codec) 1029 { 1030 struct tas2783_prv *tas_dev = 1031 snd_soc_component_get_drvdata(codec); 1032 tas_dev->component = NULL; 1033 } 1034 1035 static const struct snd_soc_component_driver soc_codec_driver_tasdevice = { 1036 .probe = tas_component_probe, 1037 .remove = tas_component_remove, 1038 .controls = tas2783_snd_controls, 1039 .num_controls = ARRAY_SIZE(tas2783_snd_controls), 1040 .dapm_widgets = tas_dapm_widgets, 1041 .num_dapm_widgets = ARRAY_SIZE(tas_dapm_widgets), 1042 .dapm_routes = tas_audio_map, 1043 .num_dapm_routes = ARRAY_SIZE(tas_audio_map), 1044 .idle_bias_on = 1, 1045 .endianness = 1, 1046 }; 1047 1048 static s32 tas_init(struct tas2783_prv *tas_dev) 1049 { 1050 s32 ret; 1051 1052 dev_set_drvdata(tas_dev->dev, tas_dev); 1053 ret = devm_snd_soc_register_component(tas_dev->dev, 1054 &soc_codec_driver_tasdevice, 1055 tas_dai_driver, 1056 ARRAY_SIZE(tas_dai_driver)); 1057 if (ret) { 1058 dev_err(tas_dev->dev, "%s: codec register error:%d.\n", 1059 __func__, ret); 1060 return ret; 1061 } 1062 1063 /* set autosuspend parameters */ 1064 pm_runtime_set_autosuspend_delay(tas_dev->dev, 3000); 1065 pm_runtime_use_autosuspend(tas_dev->dev); 1066 /* make sure the device does not suspend immediately */ 1067 pm_runtime_mark_last_busy(tas_dev->dev); 1068 pm_runtime_enable(tas_dev->dev); 1069 1070 return ret; 1071 } 1072 1073 static s32 tas2783_sdca_dev_suspend(struct device *dev) 1074 { 1075 struct tas2783_prv *tas_dev = dev_get_drvdata(dev); 1076 1077 if (!tas_dev->hw_init) 1078 return 0; 1079 1080 regcache_cache_only(tas_dev->regmap, true); 1081 return 0; 1082 } 1083 1084 static s32 tas2783_sdca_dev_system_suspend(struct device *dev) 1085 { 1086 return tas2783_sdca_dev_suspend(dev); 1087 } 1088 1089 static s32 tas2783_sdca_dev_resume(struct device *dev) 1090 { 1091 struct sdw_slave *slave = dev_to_sdw_dev(dev); 1092 struct tas2783_prv *tas_dev = dev_get_drvdata(dev); 1093 int ret; 1094 1095 ret = sdw_slave_wait_for_init(slave, TAS2783_PROBE_TIMEOUT); 1096 if (ret) { 1097 sdw_show_ping_status(slave->bus, true); 1098 return ret; 1099 } 1100 1101 regcache_cache_only(tas_dev->regmap, false); 1102 regcache_sync(tas_dev->regmap); 1103 return 0; 1104 } 1105 1106 static const struct dev_pm_ops tas2783_sdca_pm = { 1107 SYSTEM_SLEEP_PM_OPS(tas2783_sdca_dev_system_suspend, tas2783_sdca_dev_resume) 1108 RUNTIME_PM_OPS(tas2783_sdca_dev_suspend, tas2783_sdca_dev_resume, NULL) 1109 }; 1110 1111 static void tas_generate_fw_name(struct sdw_slave *slave, char *name, size_t size) 1112 { 1113 struct sdw_bus *bus = slave->bus; 1114 u8 unique_id = slave->id.unique_id; 1115 bool pci_found = false; 1116 #if IS_ENABLED(CONFIG_PCI) 1117 struct device *dev = &slave->dev; 1118 struct tas2783_prv *tas_dev = dev_get_drvdata(&slave->dev); 1119 struct pci_dev *pci = NULL; 1120 const char *fw_uid_prefix = tas_dev->fw_use_fallback ? "" : "0x"; 1121 1122 for (; dev; dev = dev->parent) { 1123 if (dev->bus == &pci_bus_type) { 1124 pci = to_pci_dev(dev); 1125 scnprintf(name, size, "%04X-%1X-%s%1X.bin", 1126 pci->subsystem_device, bus->link_id, 1127 fw_uid_prefix, unique_id); 1128 pci_found = true; 1129 break; 1130 } 1131 } 1132 #endif 1133 1134 if (!pci_found) 1135 scnprintf(name, size, "tas2783-%1X-%1X.bin", 1136 bus->link_id, unique_id); 1137 } 1138 1139 static s32 tas_fw_load(struct tas2783_prv *tas_dev, struct sdw_slave *slave) 1140 { 1141 s32 ret; 1142 u8 unique_id = tas_dev->sdw_peripheral->id.unique_id; 1143 1144 tas_generate_fw_name(slave, tas_dev->rca_binaryname, 1145 sizeof(tas_dev->rca_binaryname)); 1146 1147 tas_dev->fw_dl_task_done = false; 1148 ret = request_firmware_nowait(THIS_MODULE, FW_ACTION_UEVENT, 1149 tas_dev->rca_binaryname, tas_dev->dev, 1150 GFP_KERNEL, tas_dev, tas2783_fw_ready); 1151 if (ret) { 1152 dev_err(tas_dev->dev, 1153 "firmware request failed for uid=%d, ret=%d\n", 1154 unique_id, ret); 1155 return ret; 1156 } 1157 1158 ret = wait_event_timeout(tas_dev->fw_wait, tas_dev->fw_dl_task_done, 1159 msecs_to_jiffies(TIMEOUT_FW_DL_MS)); 1160 if (!ret) { 1161 dev_err(tas_dev->dev, "fw request, wait_event timeout\n"); 1162 return -EAGAIN; 1163 } 1164 1165 return 0; 1166 } 1167 1168 static s32 tas_io_init(struct device *dev, struct sdw_slave *slave) 1169 { 1170 struct tas2783_prv *tas_dev = dev_get_drvdata(dev); 1171 s32 ret; 1172 1173 if (tas_dev->hw_init) 1174 return 0; 1175 1176 tas_dev->fw_dl_success = false; 1177 1178 ret = regmap_write(tas_dev->regmap, TAS2783_SW_RESET, 0x1); 1179 if (ret) { 1180 dev_err(dev, "sw reset failed, err=%d", ret); 1181 return ret; 1182 } 1183 usleep_range(2000, 2200); 1184 1185 tas_dev->fw_use_fallback = false; 1186 ret = tas_fw_load(tas_dev, slave); 1187 if (!ret && tas_dev->fw_use_fallback) 1188 ret = tas_fw_load(tas_dev, slave); 1189 1190 if (!ret) { 1191 if (tas_dev->sa_func_data) 1192 ret = sdca_regmap_write_init(dev, tas_dev->regmap, 1193 tas_dev->sa_func_data); 1194 else 1195 ret = regmap_multi_reg_write(tas_dev->regmap, tas2783_init_seq, 1196 ARRAY_SIZE(tas2783_init_seq)); 1197 1198 if (ret) 1199 dev_err(tas_dev->dev, 1200 "init writes failed, err=%d", ret); 1201 else 1202 tas_dev->hw_init = true; 1203 } 1204 1205 return ret; 1206 } 1207 1208 static s32 tas_update_status(struct sdw_slave *slave, 1209 enum sdw_slave_status status) 1210 { 1211 struct tas2783_prv *tas_dev = dev_get_drvdata(&slave->dev); 1212 struct device *dev = &slave->dev; 1213 1214 dev_dbg(dev, "Peripheral status = %s", 1215 status == SDW_SLAVE_UNATTACHED ? "unattached" : 1216 status == SDW_SLAVE_ATTACHED ? "attached" : "alert"); 1217 1218 tas_dev->status = status; 1219 if (status == SDW_SLAVE_UNATTACHED) 1220 tas_dev->hw_init = false; 1221 1222 /* Perform initialization only if slave status 1223 * is present and hw_init flag is false 1224 */ 1225 if (tas_dev->hw_init || tas_dev->status != SDW_SLAVE_ATTACHED) 1226 return 0; 1227 1228 /* updated the cache data to device */ 1229 regcache_cache_only(tas_dev->regmap, false); 1230 regcache_sync(tas_dev->regmap); 1231 1232 /* perform I/O transfers required for Slave initialization */ 1233 return tas_io_init(&slave->dev, slave); 1234 } 1235 1236 /* 1237 * TAS2783 requires explicit port prepare during playback stream 1238 * setup even when simple_ch_prep_sm is enabled. Without this, 1239 * the port fails to enter the prepared state resulting in no audio output. 1240 */ 1241 static int tas_port_prep(struct sdw_slave *slave, struct sdw_prepare_ch *prep_ch, 1242 enum sdw_port_prep_ops pre_ops) 1243 { 1244 struct device *dev = &slave->dev; 1245 struct sdw_dpn_prop *dpn_prop; 1246 u32 addr; 1247 int ret; 1248 1249 dpn_prop = slave->prop.sink_dpn_prop; 1250 if (!dpn_prop || !dpn_prop->simple_ch_prep_sm) 1251 return 0; 1252 1253 addr = SDW_DPN_PREPARECTRL(prep_ch->num); 1254 switch (pre_ops) { 1255 case SDW_OPS_PORT_PRE_PREP: 1256 ret = sdw_write_no_pm(slave, addr, prep_ch->ch_mask); 1257 if (ret) 1258 dev_err(dev, "prep failed for port %d, err=%d\n", 1259 prep_ch->num, ret); 1260 return ret; 1261 1262 case SDW_OPS_PORT_PRE_DEPREP: 1263 ret = sdw_write_no_pm(slave, addr, 0x00); 1264 if (ret) 1265 dev_err(dev, "de-prep failed for port %d, err=%d\n", 1266 prep_ch->num, ret); 1267 return ret; 1268 1269 case SDW_OPS_PORT_POST_PREP: 1270 case SDW_OPS_PORT_POST_DEPREP: 1271 /* No POST handling required for TAS2783 */ 1272 return 0; 1273 } 1274 1275 return 0; 1276 } 1277 1278 static const struct sdw_slave_ops tas_sdw_ops = { 1279 .update_status = tas_update_status, 1280 .port_prep = tas_port_prep, 1281 }; 1282 1283 static void tas_remove(struct tas2783_prv *tas_dev) 1284 { 1285 snd_soc_unregister_component(tas_dev->dev); 1286 } 1287 1288 static s32 tas_sdw_probe(struct sdw_slave *peripheral, 1289 const struct sdw_device_id *id) 1290 { 1291 struct regmap *regmap; 1292 struct device *dev = &peripheral->dev; 1293 struct tas2783_prv *tas_dev; 1294 struct sdca_function_data *function_data = NULL; 1295 int ret, i; 1296 1297 ret = sdw_slave_read_prop(peripheral); 1298 if (ret) 1299 return dev_err_probe(dev, ret, 1300 "slave property read failed"); 1301 1302 tas_dev = devm_kzalloc(dev, sizeof(*tas_dev), GFP_KERNEL); 1303 if (!tas_dev) 1304 return dev_err_probe(dev, -ENOMEM, 1305 "Failed devm_kzalloc"); 1306 1307 i = -1; 1308 /* check if we have any SDCA function data available */ 1309 if (peripheral->sdca_data.num_functions > 0) { 1310 dev_dbg(dev, "SDCA functions found: %d", peripheral->sdca_data.num_functions); 1311 1312 /* Look for Smart Amp function type */ 1313 for (i = 0; i < peripheral->sdca_data.num_functions; i++) { 1314 if (peripheral->sdca_data.function[i].type == 1315 SDCA_FUNCTION_TYPE_SMART_AMP) { 1316 dev_info(dev, "Found Smart Amp function at index %d", i); 1317 break; 1318 } 1319 } 1320 } 1321 1322 if (i >= 0 && i < peripheral->sdca_data.num_functions) { 1323 /* Allocate memory for function data */ 1324 function_data = devm_kzalloc(dev, sizeof(*function_data), 1325 GFP_KERNEL); 1326 if (!function_data) 1327 return dev_err_probe(dev, -ENOMEM, 1328 "failed to parse sdca functions"); 1329 1330 function_data->desc = &peripheral->sdca_data.function[i]; 1331 1332 /* Parse the function */ 1333 ret = sdca_parse_function(dev, peripheral, function_data); 1334 if (!ret) 1335 tas_dev->sa_func_data = function_data; 1336 else 1337 dev_warn(dev, "smartamp function parse failed:err%d, using defaults", ret); 1338 } 1339 1340 tas_dev->dev = dev; 1341 tas_dev->sdw_peripheral = peripheral; 1342 tas_dev->hw_init = false; 1343 mutex_init(&tas_dev->calib_lock); 1344 mutex_init(&tas_dev->pde_lock); 1345 1346 init_waitqueue_head(&tas_dev->fw_wait); 1347 dev_set_drvdata(dev, tas_dev); 1348 regmap = devm_regmap_init_sdw_mbq_cfg(&peripheral->dev, 1349 peripheral, 1350 &tas_regmap, 1351 &tas2783_mbq_cfg); 1352 if (IS_ERR(regmap)) 1353 return dev_err_probe(dev, PTR_ERR(regmap), 1354 "Failed devm_regmap_init_sdw."); 1355 1356 /* keep in cache until the device is fully initialized */ 1357 regcache_cache_only(regmap, true); 1358 tas_dev->regmap = regmap; 1359 return tas_init(tas_dev); 1360 } 1361 1362 static void tas_sdw_remove(struct sdw_slave *peripheral) 1363 { 1364 struct tas2783_prv *tas_dev = dev_get_drvdata(&peripheral->dev); 1365 1366 pm_runtime_disable(tas_dev->dev); 1367 tas_remove(tas_dev); 1368 mutex_destroy(&tas_dev->calib_lock); 1369 mutex_destroy(&tas_dev->pde_lock); 1370 dev_set_drvdata(&peripheral->dev, NULL); 1371 } 1372 1373 static const struct sdw_device_id tas_sdw_id[] = { 1374 /* chipid for the TAS2783 is 0x0000 */ 1375 SDW_SLAVE_ENTRY(0x0102, 0x0000, 0), 1376 {}, 1377 }; 1378 MODULE_DEVICE_TABLE(sdw, tas_sdw_id); 1379 1380 static struct sdw_driver tas_sdw_driver = { 1381 .driver = { 1382 .name = "slave-tas2783", 1383 .pm = pm_ptr(&tas2783_sdca_pm), 1384 }, 1385 .probe = tas_sdw_probe, 1386 .remove = tas_sdw_remove, 1387 .ops = &tas_sdw_ops, 1388 .id_table = tas_sdw_id, 1389 }; 1390 module_sdw_driver(tas_sdw_driver); 1391 1392 MODULE_IMPORT_NS("SND_SOC_SDCA"); 1393 MODULE_AUTHOR("Texas Instruments Inc."); 1394 MODULE_DESCRIPTION("ASoC TAS2783 SoundWire Driver"); 1395 MODULE_LICENSE("GPL"); 1396