| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 1 | /* | 
|  | 2 | * Apple Onboard Audio driver for tas codec | 
|  | 3 | * | 
|  | 4 | * Copyright 2006 Johannes Berg <johannes@sipsolutions.net> | 
|  | 5 | * | 
|  | 6 | * GPL v2, can be found in COPYING. | 
|  | 7 | * | 
|  | 8 | * Open questions: | 
|  | 9 | *  - How to distinguish between 3004 and versions? | 
|  | 10 | * | 
|  | 11 | * FIXMEs: | 
|  | 12 | *  - This codec driver doesn't honour the 'connected' | 
|  | 13 | *    property of the aoa_codec struct, hence if | 
|  | 14 | *    it is used in machines where not everything is | 
|  | 15 | *    connected it will display wrong mixer elements. | 
|  | 16 | *  - Driver assumes that the microphone is always | 
|  | 17 | *    monaureal and connected to the right channel of | 
|  | 18 | *    the input. This should also be a codec-dependent | 
|  | 19 | *    flag, maybe the codec should have 3 different | 
|  | 20 | *    bits for the three different possibilities how | 
|  | 21 | *    it can be hooked up... | 
|  | 22 | *    But as long as I don't see any hardware hooked | 
|  | 23 | *    up that way... | 
|  | 24 | *  - As Apple notes in their code, the tas3004 seems | 
|  | 25 | *    to delay the right channel by one sample. You can | 
|  | 26 | *    see this when for example recording stereo in | 
|  | 27 | *    audacity, or recording the tas output via cable | 
|  | 28 | *    on another machine (use a sinus generator or so). | 
|  | 29 | *    I tried programming the BiQuads but couldn't | 
|  | 30 | *    make the delay work, maybe someone can read the | 
|  | 31 | *    datasheet and fix it. The relevant Apple comment | 
|  | 32 | *    is in AppleTAS3004Audio.cpp lines 1637 ff. Note | 
|  | 33 | *    that their comment describing how they program | 
|  | 34 | *    the filters sucks... | 
|  | 35 | * | 
|  | 36 | * Other things: | 
|  | 37 | *  - this should actually register *two* aoa_codec | 
|  | 38 | *    structs since it has two inputs. Then it must | 
|  | 39 | *    use the prepare callback to forbid running the | 
|  | 40 | *    secondary output on a different clock. | 
|  | 41 | *    Also, whatever bus knows how to do this must | 
|  | 42 | *    provide two soundbus_dev devices and the fabric | 
|  | 43 | *    must be able to link them correctly. | 
|  | 44 | * | 
|  | 45 | *    I don't even know if Apple ever uses the second | 
|  | 46 | *    port on the tas3004 though, I don't think their | 
|  | 47 | *    i2s controllers can even do it. OTOH, they all | 
|  | 48 | *    derive the clocks from common clocks, so it | 
|  | 49 | *    might just be possible. The framework allows the | 
|  | 50 | *    codec to refine the transfer_info items in the | 
|  | 51 | *    usable callback, so we can simply remove the | 
|  | 52 | *    rates the second instance is not using when it | 
|  | 53 | *    actually is in use. | 
|  | 54 | *    Maybe we'll need to make the sound busses have | 
|  | 55 | *    a 'clock group id' value so the codec can | 
|  | 56 | *    determine if the two outputs can be driven at | 
|  | 57 | *    the same time. But that is likely overkill, up | 
|  | 58 | *    to the fabric to not link them up incorrectly, | 
|  | 59 | *    and up to the hardware designer to not wire | 
|  | 60 | *    them up in some weird unusable way. | 
|  | 61 | */ | 
|  | 62 | #include <stddef.h> | 
|  | 63 | #include <linux/i2c.h> | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 64 | #include <asm/pmac_low_i2c.h> | 
|  | 65 | #include <asm/prom.h> | 
|  | 66 | #include <linux/delay.h> | 
|  | 67 | #include <linux/module.h> | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 68 | #include <linux/mutex.h> | 
|  | 69 |  | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 70 | MODULE_AUTHOR("Johannes Berg <johannes@sipsolutions.net>"); | 
|  | 71 | MODULE_LICENSE("GPL"); | 
|  | 72 | MODULE_DESCRIPTION("tas codec driver for snd-aoa"); | 
|  | 73 |  | 
| Johannes Berg | 888dcb7 | 2008-10-23 15:47:56 +0200 | [diff] [blame] | 74 | #include "tas.h" | 
|  | 75 | #include "tas-gain-table.h" | 
|  | 76 | #include "tas-basstreble.h" | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 77 | #include "../aoa.h" | 
|  | 78 | #include "../soundbus/soundbus.h" | 
|  | 79 |  | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 80 | #define PFX "snd-aoa-codec-tas: " | 
|  | 81 |  | 
| Benjamin Herrenschmidt | 6a4f578 | 2006-07-10 04:44:39 -0700 | [diff] [blame] | 82 |  | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 83 | struct tas { | 
|  | 84 | struct aoa_codec	codec; | 
|  | 85 | struct i2c_client	i2c; | 
| Benjamin Herrenschmidt | 6a4f578 | 2006-07-10 04:44:39 -0700 | [diff] [blame] | 86 | u32			mute_l:1, mute_r:1 , | 
|  | 87 | controls_created:1 , | 
|  | 88 | drc_enabled:1, | 
|  | 89 | hw_enabled:1; | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 90 | u8			cached_volume_l, cached_volume_r; | 
|  | 91 | u8			mixer_l[3], mixer_r[3]; | 
| Johannes Berg | 5009932 | 2006-07-10 04:44:41 -0700 | [diff] [blame] | 92 | u8			bass, treble; | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 93 | u8			acr; | 
| Benjamin Herrenschmidt | 6a4f578 | 2006-07-10 04:44:39 -0700 | [diff] [blame] | 94 | int			drc_range; | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 95 | /* protects hardware access against concurrency from | 
|  | 96 | * userspace when hitting controls and during | 
|  | 97 | * codec init/suspend/resume */ | 
|  | 98 | struct mutex		mtx; | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 99 | }; | 
|  | 100 |  | 
| Benjamin Herrenschmidt | 6a4f578 | 2006-07-10 04:44:39 -0700 | [diff] [blame] | 101 | static int tas_reset_init(struct tas *tas); | 
|  | 102 |  | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 103 | static struct tas *codec_to_tas(struct aoa_codec *codec) | 
|  | 104 | { | 
|  | 105 | return container_of(codec, struct tas, codec); | 
|  | 106 | } | 
|  | 107 |  | 
|  | 108 | static inline int tas_write_reg(struct tas *tas, u8 reg, u8 len, u8 *data) | 
|  | 109 | { | 
|  | 110 | if (len == 1) | 
|  | 111 | return i2c_smbus_write_byte_data(&tas->i2c, reg, *data); | 
|  | 112 | else | 
|  | 113 | return i2c_smbus_write_i2c_block_data(&tas->i2c, reg, len, data); | 
|  | 114 | } | 
|  | 115 |  | 
| Benjamin Herrenschmidt | 6a4f578 | 2006-07-10 04:44:39 -0700 | [diff] [blame] | 116 | static void tas3004_set_drc(struct tas *tas) | 
|  | 117 | { | 
|  | 118 | unsigned char val[6]; | 
|  | 119 |  | 
|  | 120 | if (tas->drc_enabled) | 
|  | 121 | val[0] = 0x50; /* 3:1 above threshold */ | 
|  | 122 | else | 
|  | 123 | val[0] = 0x51; /* disabled */ | 
|  | 124 | val[1] = 0x02; /* 1:1 below threshold */ | 
|  | 125 | if (tas->drc_range > 0xef) | 
|  | 126 | val[2] = 0xef; | 
|  | 127 | else if (tas->drc_range < 0) | 
|  | 128 | val[2] = 0x00; | 
|  | 129 | else | 
|  | 130 | val[2] = tas->drc_range; | 
|  | 131 | val[3] = 0xb0; | 
|  | 132 | val[4] = 0x60; | 
|  | 133 | val[5] = 0xa0; | 
|  | 134 |  | 
|  | 135 | tas_write_reg(tas, TAS_REG_DRC, 6, val); | 
|  | 136 | } | 
|  | 137 |  | 
| Johannes Berg | 5009932 | 2006-07-10 04:44:41 -0700 | [diff] [blame] | 138 | static void tas_set_treble(struct tas *tas) | 
|  | 139 | { | 
|  | 140 | u8 tmp; | 
|  | 141 |  | 
|  | 142 | tmp = tas3004_treble(tas->treble); | 
|  | 143 | tas_write_reg(tas, TAS_REG_TREBLE, 1, &tmp); | 
|  | 144 | } | 
|  | 145 |  | 
|  | 146 | static void tas_set_bass(struct tas *tas) | 
|  | 147 | { | 
|  | 148 | u8 tmp; | 
|  | 149 |  | 
|  | 150 | tmp = tas3004_bass(tas->bass); | 
|  | 151 | tas_write_reg(tas, TAS_REG_BASS, 1, &tmp); | 
|  | 152 | } | 
|  | 153 |  | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 154 | static void tas_set_volume(struct tas *tas) | 
|  | 155 | { | 
|  | 156 | u8 block[6]; | 
|  | 157 | int tmp; | 
|  | 158 | u8 left, right; | 
|  | 159 |  | 
|  | 160 | left = tas->cached_volume_l; | 
|  | 161 | right = tas->cached_volume_r; | 
|  | 162 |  | 
|  | 163 | if (left > 177) left = 177; | 
|  | 164 | if (right > 177) right = 177; | 
|  | 165 |  | 
| Benjamin Herrenschmidt | 6a4f578 | 2006-07-10 04:44:39 -0700 | [diff] [blame] | 166 | if (tas->mute_l) left = 0; | 
|  | 167 | if (tas->mute_r) right = 0; | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 168 |  | 
|  | 169 | /* analysing the volume and mixer tables shows | 
|  | 170 | * that they are similar enough when we shift | 
|  | 171 | * the mixer table down by 4 bits. The error | 
|  | 172 | * is miniscule, in just one item the error | 
|  | 173 | * is 1, at a value of 0x07f17b (mixer table | 
|  | 174 | * value is 0x07f17a) */ | 
|  | 175 | tmp = tas_gaintable[left]; | 
|  | 176 | block[0] = tmp>>20; | 
|  | 177 | block[1] = tmp>>12; | 
|  | 178 | block[2] = tmp>>4; | 
|  | 179 | tmp = tas_gaintable[right]; | 
|  | 180 | block[3] = tmp>>20; | 
|  | 181 | block[4] = tmp>>12; | 
|  | 182 | block[5] = tmp>>4; | 
|  | 183 | tas_write_reg(tas, TAS_REG_VOL, 6, block); | 
|  | 184 | } | 
|  | 185 |  | 
|  | 186 | static void tas_set_mixer(struct tas *tas) | 
|  | 187 | { | 
|  | 188 | u8 block[9]; | 
|  | 189 | int tmp, i; | 
|  | 190 | u8 val; | 
|  | 191 |  | 
|  | 192 | for (i=0;i<3;i++) { | 
|  | 193 | val = tas->mixer_l[i]; | 
|  | 194 | if (val > 177) val = 177; | 
|  | 195 | tmp = tas_gaintable[val]; | 
|  | 196 | block[3*i+0] = tmp>>16; | 
|  | 197 | block[3*i+1] = tmp>>8; | 
|  | 198 | block[3*i+2] = tmp; | 
|  | 199 | } | 
|  | 200 | tas_write_reg(tas, TAS_REG_LMIX, 9, block); | 
|  | 201 |  | 
|  | 202 | for (i=0;i<3;i++) { | 
|  | 203 | val = tas->mixer_r[i]; | 
|  | 204 | if (val > 177) val = 177; | 
|  | 205 | tmp = tas_gaintable[val]; | 
|  | 206 | block[3*i+0] = tmp>>16; | 
|  | 207 | block[3*i+1] = tmp>>8; | 
|  | 208 | block[3*i+2] = tmp; | 
|  | 209 | } | 
|  | 210 | tas_write_reg(tas, TAS_REG_RMIX, 9, block); | 
|  | 211 | } | 
|  | 212 |  | 
|  | 213 | /* alsa stuff */ | 
|  | 214 |  | 
|  | 215 | static int tas_dev_register(struct snd_device *dev) | 
|  | 216 | { | 
|  | 217 | return 0; | 
|  | 218 | } | 
|  | 219 |  | 
|  | 220 | static struct snd_device_ops ops = { | 
|  | 221 | .dev_register = tas_dev_register, | 
|  | 222 | }; | 
|  | 223 |  | 
|  | 224 | static int tas_snd_vol_info(struct snd_kcontrol *kcontrol, | 
|  | 225 | struct snd_ctl_elem_info *uinfo) | 
|  | 226 | { | 
|  | 227 | uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER; | 
|  | 228 | uinfo->count = 2; | 
|  | 229 | uinfo->value.integer.min = 0; | 
|  | 230 | uinfo->value.integer.max = 177; | 
|  | 231 | return 0; | 
|  | 232 | } | 
|  | 233 |  | 
|  | 234 | static int tas_snd_vol_get(struct snd_kcontrol *kcontrol, | 
|  | 235 | struct snd_ctl_elem_value *ucontrol) | 
|  | 236 | { | 
|  | 237 | struct tas *tas = snd_kcontrol_chip(kcontrol); | 
|  | 238 |  | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 239 | mutex_lock(&tas->mtx); | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 240 | ucontrol->value.integer.value[0] = tas->cached_volume_l; | 
|  | 241 | ucontrol->value.integer.value[1] = tas->cached_volume_r; | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 242 | mutex_unlock(&tas->mtx); | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 243 | return 0; | 
|  | 244 | } | 
|  | 245 |  | 
|  | 246 | static int tas_snd_vol_put(struct snd_kcontrol *kcontrol, | 
|  | 247 | struct snd_ctl_elem_value *ucontrol) | 
|  | 248 | { | 
|  | 249 | struct tas *tas = snd_kcontrol_chip(kcontrol); | 
|  | 250 |  | 
| Takashi Iwai | 498ade1 | 2007-11-15 16:16:32 +0100 | [diff] [blame] | 251 | if (ucontrol->value.integer.value[0] < 0 || | 
|  | 252 | ucontrol->value.integer.value[0] > 177) | 
|  | 253 | return -EINVAL; | 
|  | 254 | if (ucontrol->value.integer.value[1] < 0 || | 
|  | 255 | ucontrol->value.integer.value[1] > 177) | 
|  | 256 | return -EINVAL; | 
|  | 257 |  | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 258 | mutex_lock(&tas->mtx); | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 259 | if (tas->cached_volume_l == ucontrol->value.integer.value[0] | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 260 | && tas->cached_volume_r == ucontrol->value.integer.value[1]) { | 
|  | 261 | mutex_unlock(&tas->mtx); | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 262 | return 0; | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 263 | } | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 264 |  | 
|  | 265 | tas->cached_volume_l = ucontrol->value.integer.value[0]; | 
|  | 266 | tas->cached_volume_r = ucontrol->value.integer.value[1]; | 
| Benjamin Herrenschmidt | 6a4f578 | 2006-07-10 04:44:39 -0700 | [diff] [blame] | 267 | if (tas->hw_enabled) | 
|  | 268 | tas_set_volume(tas); | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 269 | mutex_unlock(&tas->mtx); | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 270 | return 1; | 
|  | 271 | } | 
|  | 272 |  | 
|  | 273 | static struct snd_kcontrol_new volume_control = { | 
|  | 274 | .iface = SNDRV_CTL_ELEM_IFACE_MIXER, | 
|  | 275 | .name = "Master Playback Volume", | 
|  | 276 | .access = SNDRV_CTL_ELEM_ACCESS_READWRITE, | 
|  | 277 | .info = tas_snd_vol_info, | 
|  | 278 | .get = tas_snd_vol_get, | 
|  | 279 | .put = tas_snd_vol_put, | 
|  | 280 | }; | 
|  | 281 |  | 
| Takashi Iwai | a5ce889 | 2007-07-23 15:42:26 +0200 | [diff] [blame] | 282 | #define tas_snd_mute_info	snd_ctl_boolean_stereo_info | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 283 |  | 
|  | 284 | static int tas_snd_mute_get(struct snd_kcontrol *kcontrol, | 
|  | 285 | struct snd_ctl_elem_value *ucontrol) | 
|  | 286 | { | 
|  | 287 | struct tas *tas = snd_kcontrol_chip(kcontrol); | 
|  | 288 |  | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 289 | mutex_lock(&tas->mtx); | 
| Benjamin Herrenschmidt | 6a4f578 | 2006-07-10 04:44:39 -0700 | [diff] [blame] | 290 | ucontrol->value.integer.value[0] = !tas->mute_l; | 
|  | 291 | ucontrol->value.integer.value[1] = !tas->mute_r; | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 292 | mutex_unlock(&tas->mtx); | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 293 | return 0; | 
|  | 294 | } | 
|  | 295 |  | 
|  | 296 | static int tas_snd_mute_put(struct snd_kcontrol *kcontrol, | 
|  | 297 | struct snd_ctl_elem_value *ucontrol) | 
|  | 298 | { | 
|  | 299 | struct tas *tas = snd_kcontrol_chip(kcontrol); | 
|  | 300 |  | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 301 | mutex_lock(&tas->mtx); | 
| Benjamin Herrenschmidt | 6a4f578 | 2006-07-10 04:44:39 -0700 | [diff] [blame] | 302 | if (tas->mute_l == !ucontrol->value.integer.value[0] | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 303 | && tas->mute_r == !ucontrol->value.integer.value[1]) { | 
|  | 304 | mutex_unlock(&tas->mtx); | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 305 | return 0; | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 306 | } | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 307 |  | 
| Benjamin Herrenschmidt | 6a4f578 | 2006-07-10 04:44:39 -0700 | [diff] [blame] | 308 | tas->mute_l = !ucontrol->value.integer.value[0]; | 
|  | 309 | tas->mute_r = !ucontrol->value.integer.value[1]; | 
|  | 310 | if (tas->hw_enabled) | 
|  | 311 | tas_set_volume(tas); | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 312 | mutex_unlock(&tas->mtx); | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 313 | return 1; | 
|  | 314 | } | 
|  | 315 |  | 
|  | 316 | static struct snd_kcontrol_new mute_control = { | 
|  | 317 | .iface = SNDRV_CTL_ELEM_IFACE_MIXER, | 
|  | 318 | .name = "Master Playback Switch", | 
|  | 319 | .access = SNDRV_CTL_ELEM_ACCESS_READWRITE, | 
|  | 320 | .info = tas_snd_mute_info, | 
|  | 321 | .get = tas_snd_mute_get, | 
|  | 322 | .put = tas_snd_mute_put, | 
|  | 323 | }; | 
|  | 324 |  | 
|  | 325 | static int tas_snd_mixer_info(struct snd_kcontrol *kcontrol, | 
|  | 326 | struct snd_ctl_elem_info *uinfo) | 
|  | 327 | { | 
|  | 328 | uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER; | 
|  | 329 | uinfo->count = 2; | 
|  | 330 | uinfo->value.integer.min = 0; | 
|  | 331 | uinfo->value.integer.max = 177; | 
|  | 332 | return 0; | 
|  | 333 | } | 
|  | 334 |  | 
|  | 335 | static int tas_snd_mixer_get(struct snd_kcontrol *kcontrol, | 
|  | 336 | struct snd_ctl_elem_value *ucontrol) | 
|  | 337 | { | 
|  | 338 | struct tas *tas = snd_kcontrol_chip(kcontrol); | 
|  | 339 | int idx = kcontrol->private_value; | 
|  | 340 |  | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 341 | mutex_lock(&tas->mtx); | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 342 | ucontrol->value.integer.value[0] = tas->mixer_l[idx]; | 
|  | 343 | ucontrol->value.integer.value[1] = tas->mixer_r[idx]; | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 344 | mutex_unlock(&tas->mtx); | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 345 |  | 
|  | 346 | return 0; | 
|  | 347 | } | 
|  | 348 |  | 
|  | 349 | static int tas_snd_mixer_put(struct snd_kcontrol *kcontrol, | 
|  | 350 | struct snd_ctl_elem_value *ucontrol) | 
|  | 351 | { | 
|  | 352 | struct tas *tas = snd_kcontrol_chip(kcontrol); | 
|  | 353 | int idx = kcontrol->private_value; | 
|  | 354 |  | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 355 | mutex_lock(&tas->mtx); | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 356 | if (tas->mixer_l[idx] == ucontrol->value.integer.value[0] | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 357 | && tas->mixer_r[idx] == ucontrol->value.integer.value[1]) { | 
|  | 358 | mutex_unlock(&tas->mtx); | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 359 | return 0; | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 360 | } | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 361 |  | 
|  | 362 | tas->mixer_l[idx] = ucontrol->value.integer.value[0]; | 
|  | 363 | tas->mixer_r[idx] = ucontrol->value.integer.value[1]; | 
|  | 364 |  | 
| Benjamin Herrenschmidt | 6a4f578 | 2006-07-10 04:44:39 -0700 | [diff] [blame] | 365 | if (tas->hw_enabled) | 
|  | 366 | tas_set_mixer(tas); | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 367 | mutex_unlock(&tas->mtx); | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 368 | return 1; | 
|  | 369 | } | 
|  | 370 |  | 
|  | 371 | #define MIXER_CONTROL(n,descr,idx)			\ | 
|  | 372 | static struct snd_kcontrol_new n##_control = {		\ | 
|  | 373 | .iface = SNDRV_CTL_ELEM_IFACE_MIXER,		\ | 
|  | 374 | .name = descr " Playback Volume",		\ | 
|  | 375 | .access = SNDRV_CTL_ELEM_ACCESS_READWRITE,	\ | 
|  | 376 | .info = tas_snd_mixer_info,			\ | 
|  | 377 | .get = tas_snd_mixer_get,			\ | 
|  | 378 | .put = tas_snd_mixer_put,			\ | 
|  | 379 | .private_value = idx,				\ | 
|  | 380 | } | 
|  | 381 |  | 
| Johannes Berg | 14b4296 | 2006-07-10 04:44:38 -0700 | [diff] [blame] | 382 | MIXER_CONTROL(pcm1, "PCM", 0); | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 383 | MIXER_CONTROL(monitor, "Monitor", 2); | 
|  | 384 |  | 
| Johannes Berg | 9b8f52f | 2006-07-10 04:44:39 -0700 | [diff] [blame] | 385 | static int tas_snd_drc_range_info(struct snd_kcontrol *kcontrol, | 
|  | 386 | struct snd_ctl_elem_info *uinfo) | 
|  | 387 | { | 
|  | 388 | uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER; | 
|  | 389 | uinfo->count = 1; | 
|  | 390 | uinfo->value.integer.min = 0; | 
|  | 391 | uinfo->value.integer.max = TAS3004_DRC_MAX; | 
|  | 392 | return 0; | 
|  | 393 | } | 
|  | 394 |  | 
|  | 395 | static int tas_snd_drc_range_get(struct snd_kcontrol *kcontrol, | 
|  | 396 | struct snd_ctl_elem_value *ucontrol) | 
|  | 397 | { | 
|  | 398 | struct tas *tas = snd_kcontrol_chip(kcontrol); | 
|  | 399 |  | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 400 | mutex_lock(&tas->mtx); | 
| Johannes Berg | 9b8f52f | 2006-07-10 04:44:39 -0700 | [diff] [blame] | 401 | ucontrol->value.integer.value[0] = tas->drc_range; | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 402 | mutex_unlock(&tas->mtx); | 
| Johannes Berg | 9b8f52f | 2006-07-10 04:44:39 -0700 | [diff] [blame] | 403 | return 0; | 
|  | 404 | } | 
|  | 405 |  | 
|  | 406 | static int tas_snd_drc_range_put(struct snd_kcontrol *kcontrol, | 
|  | 407 | struct snd_ctl_elem_value *ucontrol) | 
|  | 408 | { | 
|  | 409 | struct tas *tas = snd_kcontrol_chip(kcontrol); | 
|  | 410 |  | 
| Takashi Iwai | 498ade1 | 2007-11-15 16:16:32 +0100 | [diff] [blame] | 411 | if (ucontrol->value.integer.value[0] < 0 || | 
|  | 412 | ucontrol->value.integer.value[0] > TAS3004_DRC_MAX) | 
|  | 413 | return -EINVAL; | 
|  | 414 |  | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 415 | mutex_lock(&tas->mtx); | 
|  | 416 | if (tas->drc_range == ucontrol->value.integer.value[0]) { | 
|  | 417 | mutex_unlock(&tas->mtx); | 
| Johannes Berg | 9b8f52f | 2006-07-10 04:44:39 -0700 | [diff] [blame] | 418 | return 0; | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 419 | } | 
| Johannes Berg | 9b8f52f | 2006-07-10 04:44:39 -0700 | [diff] [blame] | 420 |  | 
|  | 421 | tas->drc_range = ucontrol->value.integer.value[0]; | 
|  | 422 | if (tas->hw_enabled) | 
|  | 423 | tas3004_set_drc(tas); | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 424 | mutex_unlock(&tas->mtx); | 
| Johannes Berg | 9b8f52f | 2006-07-10 04:44:39 -0700 | [diff] [blame] | 425 | return 1; | 
|  | 426 | } | 
|  | 427 |  | 
|  | 428 | static struct snd_kcontrol_new drc_range_control = { | 
|  | 429 | .iface = SNDRV_CTL_ELEM_IFACE_MIXER, | 
|  | 430 | .name = "DRC Range", | 
|  | 431 | .access = SNDRV_CTL_ELEM_ACCESS_READWRITE, | 
|  | 432 | .info = tas_snd_drc_range_info, | 
|  | 433 | .get = tas_snd_drc_range_get, | 
|  | 434 | .put = tas_snd_drc_range_put, | 
|  | 435 | }; | 
|  | 436 |  | 
| Takashi Iwai | a5ce889 | 2007-07-23 15:42:26 +0200 | [diff] [blame] | 437 | #define tas_snd_drc_switch_info		snd_ctl_boolean_mono_info | 
| Johannes Berg | 9b8f52f | 2006-07-10 04:44:39 -0700 | [diff] [blame] | 438 |  | 
|  | 439 | static int tas_snd_drc_switch_get(struct snd_kcontrol *kcontrol, | 
|  | 440 | struct snd_ctl_elem_value *ucontrol) | 
|  | 441 | { | 
|  | 442 | struct tas *tas = snd_kcontrol_chip(kcontrol); | 
|  | 443 |  | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 444 | mutex_lock(&tas->mtx); | 
| Johannes Berg | 9b8f52f | 2006-07-10 04:44:39 -0700 | [diff] [blame] | 445 | ucontrol->value.integer.value[0] = tas->drc_enabled; | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 446 | mutex_unlock(&tas->mtx); | 
| Johannes Berg | 9b8f52f | 2006-07-10 04:44:39 -0700 | [diff] [blame] | 447 | return 0; | 
|  | 448 | } | 
|  | 449 |  | 
|  | 450 | static int tas_snd_drc_switch_put(struct snd_kcontrol *kcontrol, | 
|  | 451 | struct snd_ctl_elem_value *ucontrol) | 
|  | 452 | { | 
|  | 453 | struct tas *tas = snd_kcontrol_chip(kcontrol); | 
|  | 454 |  | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 455 | mutex_lock(&tas->mtx); | 
|  | 456 | if (tas->drc_enabled == ucontrol->value.integer.value[0]) { | 
|  | 457 | mutex_unlock(&tas->mtx); | 
| Johannes Berg | 9b8f52f | 2006-07-10 04:44:39 -0700 | [diff] [blame] | 458 | return 0; | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 459 | } | 
| Johannes Berg | 9b8f52f | 2006-07-10 04:44:39 -0700 | [diff] [blame] | 460 |  | 
| Takashi Iwai | 498ade1 | 2007-11-15 16:16:32 +0100 | [diff] [blame] | 461 | tas->drc_enabled = !!ucontrol->value.integer.value[0]; | 
| Johannes Berg | 9b8f52f | 2006-07-10 04:44:39 -0700 | [diff] [blame] | 462 | if (tas->hw_enabled) | 
|  | 463 | tas3004_set_drc(tas); | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 464 | mutex_unlock(&tas->mtx); | 
| Johannes Berg | 9b8f52f | 2006-07-10 04:44:39 -0700 | [diff] [blame] | 465 | return 1; | 
|  | 466 | } | 
|  | 467 |  | 
|  | 468 | static struct snd_kcontrol_new drc_switch_control = { | 
|  | 469 | .iface = SNDRV_CTL_ELEM_IFACE_MIXER, | 
|  | 470 | .name = "DRC Range Switch", | 
|  | 471 | .access = SNDRV_CTL_ELEM_ACCESS_READWRITE, | 
|  | 472 | .info = tas_snd_drc_switch_info, | 
|  | 473 | .get = tas_snd_drc_switch_get, | 
|  | 474 | .put = tas_snd_drc_switch_put, | 
|  | 475 | }; | 
|  | 476 |  | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 477 | static int tas_snd_capture_source_info(struct snd_kcontrol *kcontrol, | 
|  | 478 | struct snd_ctl_elem_info *uinfo) | 
|  | 479 | { | 
|  | 480 | static char *texts[] = { "Line-In", "Microphone" }; | 
|  | 481 |  | 
|  | 482 | uinfo->type = SNDRV_CTL_ELEM_TYPE_ENUMERATED; | 
|  | 483 | uinfo->count = 1; | 
|  | 484 | uinfo->value.enumerated.items = 2; | 
|  | 485 | if (uinfo->value.enumerated.item > 1) | 
|  | 486 | uinfo->value.enumerated.item = 1; | 
|  | 487 | strcpy(uinfo->value.enumerated.name, texts[uinfo->value.enumerated.item]); | 
|  | 488 | return 0; | 
|  | 489 | } | 
|  | 490 |  | 
|  | 491 | static int tas_snd_capture_source_get(struct snd_kcontrol *kcontrol, | 
|  | 492 | struct snd_ctl_elem_value *ucontrol) | 
|  | 493 | { | 
|  | 494 | struct tas *tas = snd_kcontrol_chip(kcontrol); | 
|  | 495 |  | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 496 | mutex_lock(&tas->mtx); | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 497 | ucontrol->value.enumerated.item[0] = !!(tas->acr & TAS_ACR_INPUT_B); | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 498 | mutex_unlock(&tas->mtx); | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 499 | return 0; | 
|  | 500 | } | 
|  | 501 |  | 
|  | 502 | static int tas_snd_capture_source_put(struct snd_kcontrol *kcontrol, | 
|  | 503 | struct snd_ctl_elem_value *ucontrol) | 
|  | 504 | { | 
|  | 505 | struct tas *tas = snd_kcontrol_chip(kcontrol); | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 506 | int oldacr; | 
|  | 507 |  | 
| Takashi Iwai | 498ade1 | 2007-11-15 16:16:32 +0100 | [diff] [blame] | 508 | if (ucontrol->value.enumerated.item[0] > 1) | 
|  | 509 | return -EINVAL; | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 510 | mutex_lock(&tas->mtx); | 
|  | 511 | oldacr = tas->acr; | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 512 |  | 
| Paul Mackerras | 80b8d5d | 2006-10-31 15:24:45 +0100 | [diff] [blame] | 513 | /* | 
|  | 514 | * Despite what the data sheet says in one place, the | 
|  | 515 | * TAS_ACR_B_MONAUREAL bit forces mono output even when | 
|  | 516 | * input A (line in) is selected. | 
|  | 517 | */ | 
|  | 518 | tas->acr &= ~(TAS_ACR_INPUT_B | TAS_ACR_B_MONAUREAL); | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 519 | if (ucontrol->value.enumerated.item[0]) | 
| Paul Mackerras | 80b8d5d | 2006-10-31 15:24:45 +0100 | [diff] [blame] | 520 | tas->acr |= TAS_ACR_INPUT_B | TAS_ACR_B_MONAUREAL | | 
|  | 521 | TAS_ACR_B_MON_SEL_RIGHT; | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 522 | if (oldacr == tas->acr) { | 
|  | 523 | mutex_unlock(&tas->mtx); | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 524 | return 0; | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 525 | } | 
| Benjamin Herrenschmidt | 6a4f578 | 2006-07-10 04:44:39 -0700 | [diff] [blame] | 526 | if (tas->hw_enabled) | 
|  | 527 | tas_write_reg(tas, TAS_REG_ACR, 1, &tas->acr); | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 528 | mutex_unlock(&tas->mtx); | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 529 | return 1; | 
|  | 530 | } | 
|  | 531 |  | 
|  | 532 | static struct snd_kcontrol_new capture_source_control = { | 
|  | 533 | .iface = SNDRV_CTL_ELEM_IFACE_MIXER, | 
|  | 534 | /* If we name this 'Input Source', it properly shows up in | 
|  | 535 | * alsamixer as a selection, * but it's shown under the | 
|  | 536 | * 'Playback' category. | 
|  | 537 | * If I name it 'Capture Source', it shows up in strange | 
|  | 538 | * ways (two bools of which one can be selected at a | 
|  | 539 | * time) but at least it's shown in the 'Capture' | 
|  | 540 | * category. | 
|  | 541 | * I was told that this was due to backward compatibility, | 
|  | 542 | * but I don't understand then why the mangling is *not* | 
|  | 543 | * done when I name it "Input Source"..... | 
|  | 544 | */ | 
|  | 545 | .name = "Capture Source", | 
|  | 546 | .access = SNDRV_CTL_ELEM_ACCESS_READWRITE, | 
|  | 547 | .info = tas_snd_capture_source_info, | 
|  | 548 | .get = tas_snd_capture_source_get, | 
|  | 549 | .put = tas_snd_capture_source_put, | 
|  | 550 | }; | 
|  | 551 |  | 
| Johannes Berg | 5009932 | 2006-07-10 04:44:41 -0700 | [diff] [blame] | 552 | static int tas_snd_treble_info(struct snd_kcontrol *kcontrol, | 
|  | 553 | struct snd_ctl_elem_info *uinfo) | 
|  | 554 | { | 
|  | 555 | uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER; | 
|  | 556 | uinfo->count = 1; | 
|  | 557 | uinfo->value.integer.min = TAS3004_TREBLE_MIN; | 
|  | 558 | uinfo->value.integer.max = TAS3004_TREBLE_MAX; | 
|  | 559 | return 0; | 
|  | 560 | } | 
|  | 561 |  | 
|  | 562 | static int tas_snd_treble_get(struct snd_kcontrol *kcontrol, | 
|  | 563 | struct snd_ctl_elem_value *ucontrol) | 
|  | 564 | { | 
|  | 565 | struct tas *tas = snd_kcontrol_chip(kcontrol); | 
|  | 566 |  | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 567 | mutex_lock(&tas->mtx); | 
| Johannes Berg | 5009932 | 2006-07-10 04:44:41 -0700 | [diff] [blame] | 568 | ucontrol->value.integer.value[0] = tas->treble; | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 569 | mutex_unlock(&tas->mtx); | 
| Johannes Berg | 5009932 | 2006-07-10 04:44:41 -0700 | [diff] [blame] | 570 | return 0; | 
|  | 571 | } | 
|  | 572 |  | 
|  | 573 | static int tas_snd_treble_put(struct snd_kcontrol *kcontrol, | 
|  | 574 | struct snd_ctl_elem_value *ucontrol) | 
|  | 575 | { | 
|  | 576 | struct tas *tas = snd_kcontrol_chip(kcontrol); | 
|  | 577 |  | 
| Takashi Iwai | 498ade1 | 2007-11-15 16:16:32 +0100 | [diff] [blame] | 578 | if (ucontrol->value.integer.value[0] < TAS3004_TREBLE_MIN || | 
|  | 579 | ucontrol->value.integer.value[0] > TAS3004_TREBLE_MAX) | 
|  | 580 | return -EINVAL; | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 581 | mutex_lock(&tas->mtx); | 
|  | 582 | if (tas->treble == ucontrol->value.integer.value[0]) { | 
|  | 583 | mutex_unlock(&tas->mtx); | 
| Johannes Berg | 5009932 | 2006-07-10 04:44:41 -0700 | [diff] [blame] | 584 | return 0; | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 585 | } | 
| Johannes Berg | 5009932 | 2006-07-10 04:44:41 -0700 | [diff] [blame] | 586 |  | 
|  | 587 | tas->treble = ucontrol->value.integer.value[0]; | 
|  | 588 | if (tas->hw_enabled) | 
|  | 589 | tas_set_treble(tas); | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 590 | mutex_unlock(&tas->mtx); | 
| Johannes Berg | 5009932 | 2006-07-10 04:44:41 -0700 | [diff] [blame] | 591 | return 1; | 
|  | 592 | } | 
|  | 593 |  | 
|  | 594 | static struct snd_kcontrol_new treble_control = { | 
|  | 595 | .iface = SNDRV_CTL_ELEM_IFACE_MIXER, | 
|  | 596 | .name = "Treble", | 
|  | 597 | .access = SNDRV_CTL_ELEM_ACCESS_READWRITE, | 
|  | 598 | .info = tas_snd_treble_info, | 
|  | 599 | .get = tas_snd_treble_get, | 
|  | 600 | .put = tas_snd_treble_put, | 
|  | 601 | }; | 
|  | 602 |  | 
|  | 603 | static int tas_snd_bass_info(struct snd_kcontrol *kcontrol, | 
|  | 604 | struct snd_ctl_elem_info *uinfo) | 
|  | 605 | { | 
|  | 606 | uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER; | 
|  | 607 | uinfo->count = 1; | 
|  | 608 | uinfo->value.integer.min = TAS3004_BASS_MIN; | 
|  | 609 | uinfo->value.integer.max = TAS3004_BASS_MAX; | 
|  | 610 | return 0; | 
|  | 611 | } | 
|  | 612 |  | 
|  | 613 | static int tas_snd_bass_get(struct snd_kcontrol *kcontrol, | 
|  | 614 | struct snd_ctl_elem_value *ucontrol) | 
|  | 615 | { | 
|  | 616 | struct tas *tas = snd_kcontrol_chip(kcontrol); | 
|  | 617 |  | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 618 | mutex_lock(&tas->mtx); | 
| Johannes Berg | 5009932 | 2006-07-10 04:44:41 -0700 | [diff] [blame] | 619 | ucontrol->value.integer.value[0] = tas->bass; | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 620 | mutex_unlock(&tas->mtx); | 
| Johannes Berg | 5009932 | 2006-07-10 04:44:41 -0700 | [diff] [blame] | 621 | return 0; | 
|  | 622 | } | 
|  | 623 |  | 
|  | 624 | static int tas_snd_bass_put(struct snd_kcontrol *kcontrol, | 
|  | 625 | struct snd_ctl_elem_value *ucontrol) | 
|  | 626 | { | 
|  | 627 | struct tas *tas = snd_kcontrol_chip(kcontrol); | 
|  | 628 |  | 
| Takashi Iwai | 498ade1 | 2007-11-15 16:16:32 +0100 | [diff] [blame] | 629 | if (ucontrol->value.integer.value[0] < TAS3004_BASS_MIN || | 
|  | 630 | ucontrol->value.integer.value[0] > TAS3004_BASS_MAX) | 
|  | 631 | return -EINVAL; | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 632 | mutex_lock(&tas->mtx); | 
|  | 633 | if (tas->bass == ucontrol->value.integer.value[0]) { | 
|  | 634 | mutex_unlock(&tas->mtx); | 
| Johannes Berg | 5009932 | 2006-07-10 04:44:41 -0700 | [diff] [blame] | 635 | return 0; | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 636 | } | 
| Johannes Berg | 5009932 | 2006-07-10 04:44:41 -0700 | [diff] [blame] | 637 |  | 
|  | 638 | tas->bass = ucontrol->value.integer.value[0]; | 
|  | 639 | if (tas->hw_enabled) | 
|  | 640 | tas_set_bass(tas); | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 641 | mutex_unlock(&tas->mtx); | 
| Johannes Berg | 5009932 | 2006-07-10 04:44:41 -0700 | [diff] [blame] | 642 | return 1; | 
|  | 643 | } | 
|  | 644 |  | 
|  | 645 | static struct snd_kcontrol_new bass_control = { | 
|  | 646 | .iface = SNDRV_CTL_ELEM_IFACE_MIXER, | 
|  | 647 | .name = "Bass", | 
|  | 648 | .access = SNDRV_CTL_ELEM_ACCESS_READWRITE, | 
|  | 649 | .info = tas_snd_bass_info, | 
|  | 650 | .get = tas_snd_bass_get, | 
|  | 651 | .put = tas_snd_bass_put, | 
|  | 652 | }; | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 653 |  | 
|  | 654 | static struct transfer_info tas_transfers[] = { | 
|  | 655 | { | 
|  | 656 | /* input */ | 
| Roel Kluin | c7d03bc | 2008-08-20 10:31:38 +0200 | [diff] [blame] | 657 | .formats = SNDRV_PCM_FMTBIT_S16_BE | SNDRV_PCM_FMTBIT_S24_BE, | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 658 | .rates = SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_44100 | SNDRV_PCM_RATE_48000, | 
|  | 659 | .transfer_in = 1, | 
|  | 660 | }, | 
|  | 661 | { | 
|  | 662 | /* output */ | 
| Roel Kluin | c7d03bc | 2008-08-20 10:31:38 +0200 | [diff] [blame] | 663 | .formats = SNDRV_PCM_FMTBIT_S16_BE | SNDRV_PCM_FMTBIT_S24_BE, | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 664 | .rates = SNDRV_PCM_RATE_32000 | SNDRV_PCM_RATE_44100 | SNDRV_PCM_RATE_48000, | 
|  | 665 | .transfer_in = 0, | 
|  | 666 | }, | 
|  | 667 | {} | 
|  | 668 | }; | 
|  | 669 |  | 
|  | 670 | static int tas_usable(struct codec_info_item *cii, | 
|  | 671 | struct transfer_info *ti, | 
|  | 672 | struct transfer_info *out) | 
|  | 673 | { | 
|  | 674 | return 1; | 
|  | 675 | } | 
|  | 676 |  | 
|  | 677 | static int tas_reset_init(struct tas *tas) | 
|  | 678 | { | 
|  | 679 | u8 tmp; | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 680 |  | 
| Benjamin Herrenschmidt | 6a4f578 | 2006-07-10 04:44:39 -0700 | [diff] [blame] | 681 | tas->codec.gpio->methods->all_amps_off(tas->codec.gpio); | 
|  | 682 | msleep(5); | 
|  | 683 | tas->codec.gpio->methods->set_hw_reset(tas->codec.gpio, 0); | 
|  | 684 | msleep(5); | 
|  | 685 | tas->codec.gpio->methods->set_hw_reset(tas->codec.gpio, 1); | 
|  | 686 | msleep(20); | 
|  | 687 | tas->codec.gpio->methods->set_hw_reset(tas->codec.gpio, 0); | 
|  | 688 | msleep(10); | 
|  | 689 | tas->codec.gpio->methods->all_amps_restore(tas->codec.gpio); | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 690 |  | 
|  | 691 | tmp = TAS_MCS_SCLK64 | TAS_MCS_SPORT_MODE_I2S | TAS_MCS_SPORT_WL_24BIT; | 
|  | 692 | if (tas_write_reg(tas, TAS_REG_MCS, 1, &tmp)) | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 693 | goto outerr; | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 694 |  | 
| Paul Mackerras | 80b8d5d | 2006-10-31 15:24:45 +0100 | [diff] [blame] | 695 | tas->acr |= TAS_ACR_ANALOG_PDOWN; | 
| Benjamin Herrenschmidt | 6a4f578 | 2006-07-10 04:44:39 -0700 | [diff] [blame] | 696 | if (tas_write_reg(tas, TAS_REG_ACR, 1, &tas->acr)) | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 697 | goto outerr; | 
| Benjamin Herrenschmidt | 6a4f578 | 2006-07-10 04:44:39 -0700 | [diff] [blame] | 698 |  | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 699 | tmp = 0; | 
|  | 700 | if (tas_write_reg(tas, TAS_REG_MCS2, 1, &tmp)) | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 701 | goto outerr; | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 702 |  | 
| Benjamin Herrenschmidt | 6a4f578 | 2006-07-10 04:44:39 -0700 | [diff] [blame] | 703 | tas3004_set_drc(tas); | 
|  | 704 |  | 
|  | 705 | /* Set treble & bass to 0dB */ | 
| Johannes Berg | 5009932 | 2006-07-10 04:44:41 -0700 | [diff] [blame] | 706 | tas->treble = TAS3004_TREBLE_ZERO; | 
|  | 707 | tas->bass = TAS3004_BASS_ZERO; | 
|  | 708 | tas_set_treble(tas); | 
|  | 709 | tas_set_bass(tas); | 
| Benjamin Herrenschmidt | 6a4f578 | 2006-07-10 04:44:39 -0700 | [diff] [blame] | 710 |  | 
|  | 711 | tas->acr &= ~TAS_ACR_ANALOG_PDOWN; | 
|  | 712 | if (tas_write_reg(tas, TAS_REG_ACR, 1, &tas->acr)) | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 713 | goto outerr; | 
| Benjamin Herrenschmidt | 6a4f578 | 2006-07-10 04:44:39 -0700 | [diff] [blame] | 714 |  | 
|  | 715 | return 0; | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 716 | outerr: | 
|  | 717 | return -ENODEV; | 
| Benjamin Herrenschmidt | 6a4f578 | 2006-07-10 04:44:39 -0700 | [diff] [blame] | 718 | } | 
|  | 719 |  | 
|  | 720 | static int tas_switch_clock(struct codec_info_item *cii, enum clock_switch clock) | 
|  | 721 | { | 
|  | 722 | struct tas *tas = cii->codec_data; | 
|  | 723 |  | 
|  | 724 | switch(clock) { | 
|  | 725 | case CLOCK_SWITCH_PREPARE_SLAVE: | 
|  | 726 | /* Clocks are going away, mute mute mute */ | 
|  | 727 | tas->codec.gpio->methods->all_amps_off(tas->codec.gpio); | 
|  | 728 | tas->hw_enabled = 0; | 
|  | 729 | break; | 
|  | 730 | case CLOCK_SWITCH_SLAVE: | 
|  | 731 | /* Clocks are back, re-init the codec */ | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 732 | mutex_lock(&tas->mtx); | 
| Benjamin Herrenschmidt | 6a4f578 | 2006-07-10 04:44:39 -0700 | [diff] [blame] | 733 | tas_reset_init(tas); | 
|  | 734 | tas_set_volume(tas); | 
|  | 735 | tas_set_mixer(tas); | 
|  | 736 | tas->hw_enabled = 1; | 
|  | 737 | tas->codec.gpio->methods->all_amps_restore(tas->codec.gpio); | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 738 | mutex_unlock(&tas->mtx); | 
| Benjamin Herrenschmidt | 6a4f578 | 2006-07-10 04:44:39 -0700 | [diff] [blame] | 739 | break; | 
|  | 740 | default: | 
|  | 741 | /* doesn't happen as of now */ | 
|  | 742 | return -EINVAL; | 
|  | 743 | } | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 744 | return 0; | 
|  | 745 | } | 
|  | 746 |  | 
| Stephen Rothwell | 1f28960 | 2007-07-23 12:10:07 +0200 | [diff] [blame] | 747 | #ifdef CONFIG_PM | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 748 | /* we are controlled via i2c and assume that is always up | 
|  | 749 | * If that wasn't the case, we'd have to suspend once | 
|  | 750 | * our i2c device is suspended, and then take note of that! */ | 
|  | 751 | static int tas_suspend(struct tas *tas) | 
|  | 752 | { | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 753 | mutex_lock(&tas->mtx); | 
| Benjamin Herrenschmidt | 6a4f578 | 2006-07-10 04:44:39 -0700 | [diff] [blame] | 754 | tas->hw_enabled = 0; | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 755 | tas->acr |= TAS_ACR_ANALOG_PDOWN; | 
|  | 756 | tas_write_reg(tas, TAS_REG_ACR, 1, &tas->acr); | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 757 | mutex_unlock(&tas->mtx); | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 758 | return 0; | 
|  | 759 | } | 
|  | 760 |  | 
|  | 761 | static int tas_resume(struct tas *tas) | 
|  | 762 | { | 
|  | 763 | /* reset codec */ | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 764 | mutex_lock(&tas->mtx); | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 765 | tas_reset_init(tas); | 
|  | 766 | tas_set_volume(tas); | 
|  | 767 | tas_set_mixer(tas); | 
| Benjamin Herrenschmidt | 6a4f578 | 2006-07-10 04:44:39 -0700 | [diff] [blame] | 768 | tas->hw_enabled = 1; | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 769 | mutex_unlock(&tas->mtx); | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 770 | return 0; | 
|  | 771 | } | 
|  | 772 |  | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 773 | static int _tas_suspend(struct codec_info_item *cii, pm_message_t state) | 
|  | 774 | { | 
|  | 775 | return tas_suspend(cii->codec_data); | 
|  | 776 | } | 
|  | 777 |  | 
|  | 778 | static int _tas_resume(struct codec_info_item *cii) | 
|  | 779 | { | 
|  | 780 | return tas_resume(cii->codec_data); | 
|  | 781 | } | 
| Stephen Rothwell | 1f28960 | 2007-07-23 12:10:07 +0200 | [diff] [blame] | 782 | #else /* CONFIG_PM */ | 
|  | 783 | #define _tas_suspend	NULL | 
|  | 784 | #define _tas_resume	NULL | 
|  | 785 | #endif /* CONFIG_PM */ | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 786 |  | 
|  | 787 | static struct codec_info tas_codec_info = { | 
|  | 788 | .transfers = tas_transfers, | 
|  | 789 | /* in theory, we can drive it at 512 too... | 
|  | 790 | * but so far the framework doesn't allow | 
|  | 791 | * for that and I don't see much point in it. */ | 
|  | 792 | .sysclock_factor = 256, | 
|  | 793 | /* same here, could be 32 for just one 16 bit format */ | 
|  | 794 | .bus_factor = 64, | 
|  | 795 | .owner = THIS_MODULE, | 
|  | 796 | .usable = tas_usable, | 
| Benjamin Herrenschmidt | 6a4f578 | 2006-07-10 04:44:39 -0700 | [diff] [blame] | 797 | .switch_clock = tas_switch_clock, | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 798 | .suspend = _tas_suspend, | 
|  | 799 | .resume = _tas_resume, | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 800 | }; | 
|  | 801 |  | 
|  | 802 | static int tas_init_codec(struct aoa_codec *codec) | 
|  | 803 | { | 
|  | 804 | struct tas *tas = codec_to_tas(codec); | 
|  | 805 | int err; | 
|  | 806 |  | 
|  | 807 | if (!tas->codec.gpio || !tas->codec.gpio->methods) { | 
|  | 808 | printk(KERN_ERR PFX "gpios not assigned!!\n"); | 
|  | 809 | return -EINVAL; | 
|  | 810 | } | 
|  | 811 |  | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 812 | mutex_lock(&tas->mtx); | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 813 | if (tas_reset_init(tas)) { | 
|  | 814 | printk(KERN_ERR PFX "tas failed to initialise\n"); | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 815 | mutex_unlock(&tas->mtx); | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 816 | return -ENXIO; | 
|  | 817 | } | 
| Benjamin Herrenschmidt | 6a4f578 | 2006-07-10 04:44:39 -0700 | [diff] [blame] | 818 | tas->hw_enabled = 1; | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 819 | mutex_unlock(&tas->mtx); | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 820 |  | 
|  | 821 | if (tas->codec.soundbus_dev->attach_codec(tas->codec.soundbus_dev, | 
|  | 822 | aoa_get_card(), | 
|  | 823 | &tas_codec_info, tas)) { | 
|  | 824 | printk(KERN_ERR PFX "error attaching tas to soundbus\n"); | 
|  | 825 | return -ENODEV; | 
|  | 826 | } | 
|  | 827 |  | 
|  | 828 | if (aoa_snd_device_new(SNDRV_DEV_LOWLEVEL, tas, &ops)) { | 
|  | 829 | printk(KERN_ERR PFX "failed to create tas snd device!\n"); | 
|  | 830 | return -ENODEV; | 
|  | 831 | } | 
|  | 832 | err = aoa_snd_ctl_add(snd_ctl_new1(&volume_control, tas)); | 
|  | 833 | if (err) | 
|  | 834 | goto error; | 
|  | 835 |  | 
|  | 836 | err = aoa_snd_ctl_add(snd_ctl_new1(&mute_control, tas)); | 
|  | 837 | if (err) | 
|  | 838 | goto error; | 
|  | 839 |  | 
|  | 840 | err = aoa_snd_ctl_add(snd_ctl_new1(&pcm1_control, tas)); | 
|  | 841 | if (err) | 
|  | 842 | goto error; | 
|  | 843 |  | 
|  | 844 | err = aoa_snd_ctl_add(snd_ctl_new1(&monitor_control, tas)); | 
|  | 845 | if (err) | 
|  | 846 | goto error; | 
|  | 847 |  | 
|  | 848 | err = aoa_snd_ctl_add(snd_ctl_new1(&capture_source_control, tas)); | 
|  | 849 | if (err) | 
|  | 850 | goto error; | 
|  | 851 |  | 
| Johannes Berg | 9b8f52f | 2006-07-10 04:44:39 -0700 | [diff] [blame] | 852 | err = aoa_snd_ctl_add(snd_ctl_new1(&drc_range_control, tas)); | 
|  | 853 | if (err) | 
|  | 854 | goto error; | 
|  | 855 |  | 
|  | 856 | err = aoa_snd_ctl_add(snd_ctl_new1(&drc_switch_control, tas)); | 
|  | 857 | if (err) | 
|  | 858 | goto error; | 
|  | 859 |  | 
| Johannes Berg | 5009932 | 2006-07-10 04:44:41 -0700 | [diff] [blame] | 860 | err = aoa_snd_ctl_add(snd_ctl_new1(&treble_control, tas)); | 
|  | 861 | if (err) | 
|  | 862 | goto error; | 
|  | 863 |  | 
|  | 864 | err = aoa_snd_ctl_add(snd_ctl_new1(&bass_control, tas)); | 
|  | 865 | if (err) | 
|  | 866 | goto error; | 
|  | 867 |  | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 868 | return 0; | 
|  | 869 | error: | 
|  | 870 | tas->codec.soundbus_dev->detach_codec(tas->codec.soundbus_dev, tas); | 
|  | 871 | snd_device_free(aoa_get_card(), tas); | 
|  | 872 | return err; | 
|  | 873 | } | 
|  | 874 |  | 
|  | 875 | static void tas_exit_codec(struct aoa_codec *codec) | 
|  | 876 | { | 
|  | 877 | struct tas *tas = codec_to_tas(codec); | 
|  | 878 |  | 
|  | 879 | if (!tas->codec.soundbus_dev) | 
|  | 880 | return; | 
|  | 881 | tas->codec.soundbus_dev->detach_codec(tas->codec.soundbus_dev, tas); | 
|  | 882 | } | 
| Johannes Berg | 888dcb7 | 2008-10-23 15:47:56 +0200 | [diff] [blame] | 883 |  | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 884 |  | 
|  | 885 | static struct i2c_driver tas_driver; | 
|  | 886 |  | 
|  | 887 | static int tas_create(struct i2c_adapter *adapter, | 
|  | 888 | struct device_node *node, | 
|  | 889 | int addr) | 
|  | 890 | { | 
|  | 891 | struct tas *tas; | 
|  | 892 |  | 
|  | 893 | tas = kzalloc(sizeof(struct tas), GFP_KERNEL); | 
|  | 894 |  | 
|  | 895 | if (!tas) | 
|  | 896 | return -ENOMEM; | 
|  | 897 |  | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 898 | mutex_init(&tas->mtx); | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 899 | tas->i2c.driver = &tas_driver; | 
|  | 900 | tas->i2c.adapter = adapter; | 
|  | 901 | tas->i2c.addr = addr; | 
| Johannes Berg | 9b8f52f | 2006-07-10 04:44:39 -0700 | [diff] [blame] | 902 | /* seems that half is a saner default */ | 
|  | 903 | tas->drc_range = TAS3004_DRC_MAX / 2; | 
| Jean Delvare | 023ff3e | 2007-03-27 11:50:19 +0200 | [diff] [blame] | 904 | strlcpy(tas->i2c.name, "tas audio codec", I2C_NAME_SIZE); | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 905 |  | 
|  | 906 | if (i2c_attach_client(&tas->i2c)) { | 
|  | 907 | printk(KERN_ERR PFX "failed to attach to i2c\n"); | 
|  | 908 | goto fail; | 
|  | 909 | } | 
|  | 910 |  | 
| Jean Delvare | 023ff3e | 2007-03-27 11:50:19 +0200 | [diff] [blame] | 911 | strlcpy(tas->codec.name, "tas", MAX_CODEC_NAME_LEN); | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 912 | tas->codec.owner = THIS_MODULE; | 
|  | 913 | tas->codec.init = tas_init_codec; | 
|  | 914 | tas->codec.exit = tas_exit_codec; | 
|  | 915 | tas->codec.node = of_node_get(node); | 
|  | 916 |  | 
|  | 917 | if (aoa_codec_register(&tas->codec)) { | 
|  | 918 | goto detach; | 
|  | 919 | } | 
| Benjamin Herrenschmidt | 6a4f578 | 2006-07-10 04:44:39 -0700 | [diff] [blame] | 920 | printk(KERN_DEBUG | 
|  | 921 | "snd-aoa-codec-tas: tas found, addr 0x%02x on %s\n", | 
|  | 922 | addr, node->full_name); | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 923 | return 0; | 
|  | 924 | detach: | 
|  | 925 | i2c_detach_client(&tas->i2c); | 
|  | 926 | fail: | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 927 | mutex_destroy(&tas->mtx); | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 928 | kfree(tas); | 
|  | 929 | return -EINVAL; | 
|  | 930 | } | 
|  | 931 |  | 
|  | 932 | static int tas_i2c_attach(struct i2c_adapter *adapter) | 
|  | 933 | { | 
|  | 934 | struct device_node *busnode, *dev = NULL; | 
|  | 935 | struct pmac_i2c_bus *bus; | 
|  | 936 |  | 
|  | 937 | bus = pmac_i2c_adapter_to_bus(adapter); | 
|  | 938 | if (bus == NULL) | 
|  | 939 | return -ENODEV; | 
|  | 940 | busnode = pmac_i2c_get_bus_node(bus); | 
|  | 941 |  | 
|  | 942 | while ((dev = of_get_next_child(busnode, dev)) != NULL) { | 
| Stephen Rothwell | 55b61fe | 2007-05-03 17:26:52 +1000 | [diff] [blame] | 943 | if (of_device_is_compatible(dev, "tas3004")) { | 
| Stephen Rothwell | a7edd0e | 2007-04-03 10:52:17 +1000 | [diff] [blame] | 944 | const u32 *addr; | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 945 | printk(KERN_DEBUG PFX "found tas3004\n"); | 
| Stephen Rothwell | c4f55b3 | 2007-04-03 22:39:14 +1000 | [diff] [blame] | 946 | addr = of_get_property(dev, "reg", NULL); | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 947 | if (!addr) | 
|  | 948 | continue; | 
|  | 949 | return tas_create(adapter, dev, ((*addr) >> 1) & 0x7f); | 
|  | 950 | } | 
|  | 951 | /* older machines have no 'codec' node with a 'compatible' | 
|  | 952 | * property that says 'tas3004', they just have a 'deq' | 
|  | 953 | * node without any such property... */ | 
|  | 954 | if (strcmp(dev->name, "deq") == 0) { | 
| Stephen Rothwell | a7edd0e | 2007-04-03 10:52:17 +1000 | [diff] [blame] | 955 | const u32 *_addr; | 
|  | 956 | u32 addr; | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 957 | printk(KERN_DEBUG PFX "found 'deq' node\n"); | 
| Stephen Rothwell | c4f55b3 | 2007-04-03 22:39:14 +1000 | [diff] [blame] | 958 | _addr = of_get_property(dev, "i2c-address", NULL); | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 959 | if (!_addr) | 
|  | 960 | continue; | 
|  | 961 | addr = ((*_addr) >> 1) & 0x7f; | 
|  | 962 | /* now, if the address doesn't match any of the two | 
|  | 963 | * that a tas3004 can have, we cannot handle this. | 
|  | 964 | * I doubt it ever happens but hey. */ | 
|  | 965 | if (addr != 0x34 && addr != 0x35) | 
|  | 966 | continue; | 
|  | 967 | return tas_create(adapter, dev, addr); | 
|  | 968 | } | 
|  | 969 | } | 
|  | 970 | return -ENODEV; | 
|  | 971 | } | 
|  | 972 |  | 
|  | 973 | static int tas_i2c_detach(struct i2c_client *client) | 
|  | 974 | { | 
|  | 975 | struct tas *tas = container_of(client, struct tas, i2c); | 
|  | 976 | int err; | 
|  | 977 | u8 tmp = TAS_ACR_ANALOG_PDOWN; | 
|  | 978 |  | 
|  | 979 | if ((err = i2c_detach_client(client))) | 
|  | 980 | return err; | 
|  | 981 | aoa_codec_unregister(&tas->codec); | 
|  | 982 | of_node_put(tas->codec.node); | 
|  | 983 |  | 
|  | 984 | /* power down codec chip */ | 
|  | 985 | tas_write_reg(tas, TAS_REG_ACR, 1, &tmp); | 
|  | 986 |  | 
| Johannes Berg | 3071920 | 2006-09-17 21:59:25 +0200 | [diff] [blame] | 987 | mutex_destroy(&tas->mtx); | 
| Johannes Berg | f3d9478 | 2006-06-21 15:42:43 +0200 | [diff] [blame] | 988 | kfree(tas); | 
|  | 989 | return 0; | 
|  | 990 | } | 
|  | 991 |  | 
|  | 992 | static struct i2c_driver tas_driver = { | 
|  | 993 | .driver = { | 
|  | 994 | .name = "aoa_codec_tas", | 
|  | 995 | .owner = THIS_MODULE, | 
|  | 996 | }, | 
|  | 997 | .attach_adapter = tas_i2c_attach, | 
|  | 998 | .detach_client = tas_i2c_detach, | 
|  | 999 | }; | 
|  | 1000 |  | 
|  | 1001 | static int __init tas_init(void) | 
|  | 1002 | { | 
|  | 1003 | return i2c_add_driver(&tas_driver); | 
|  | 1004 | } | 
|  | 1005 |  | 
|  | 1006 | static void __exit tas_exit(void) | 
|  | 1007 | { | 
|  | 1008 | i2c_del_driver(&tas_driver); | 
|  | 1009 | } | 
|  | 1010 |  | 
|  | 1011 | module_init(tas_init); | 
|  | 1012 | module_exit(tas_exit); |