release/src-rt-6.x/linux/linux-2.6/sound/i2c/tea6330t.c

   1 /*
   2  *  Routines for control of the TEA6330T circuit via i2c bus
   3  *  Sound fader control circuit for car radios by Philips Semiconductors
   4  *  Copyright (c) by Jaroslav Kysela <perex@suse.cz>
   5  *
   6  *
   7  *   This program is free software; you can redistribute it and/or modify
   8  *   it under the terms of the GNU General Public License as published by
   9  *   the Free Software Foundation; either version 2 of the License, or
  10  *   (at your option) any later version.
  11  *
  12  *   This program is distributed in the hope that it will be useful,
  13  *   but WITHOUT ANY WARRANTY; without even the implied warranty of
  14  *   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  15  *   GNU General Public License for more details.
  16  *
  17  *   You should have received a copy of the GNU General Public License
  18  *   along with this program; if not, write to the Free Software
  19  *   Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307 USA
  20  *
  21  */
  22
  23 #include <sound/driver.h>
  24 #include <linux/init.h>
  25 #include <linux/slab.h>
  26 #include <sound/core.h>
  27 #include <sound/control.h>
  28 #include <sound/tea6330t.h>
  29
  30 MODULE_AUTHOR("Jaroslav Kysela <perex@suse.cz>");
  31 MODULE_DESCRIPTION("Routines for control of the TEA6330T circuit via i2c bus");
  32 MODULE_LICENSE("GPL");
  33
  34 #define TEA6330T_ADDR                   (0x80>>1) /* fixed address */
  35
  36 #define TEA6330T_SADDR_VOLUME_LEFT      0x00    /* volume left */
  37 #define TEA6330T_SADDR_VOLUME_RIGHT     0x01    /* volume right */
  38 #define TEA6330T_SADDR_BASS             0x02    /* bass control */
  39 #define TEA6330T_SADDR_TREBLE           0x03    /* treble control */
  40 #define TEA6330T_SADDR_FADER            0x04    /* fader control */
  41 #define   TEA6330T_MFN                  0x20    /* mute control for selected channels */
  42 #define   TEA6330T_FCH                  0x10    /* select fader channels - front or rear */
  43 #define TEA6330T_SADDR_AUDIO_SWITCH     0x05    /* audio switch */
  44 #define   TEA6330T_GMU                  0x80    /* mute control, general mute */
  45 #define   TEA6330T_EQN                  0x40    /* equalizer switchover (0=equalizer-on) */
  46
  47
  48 struct tea6330t {
  49         struct snd_i2c_device *device;
  50         struct snd_i2c_bus *bus;
  51         int equalizer;
  52         int fader;
  53         unsigned char regs[8];
  54         unsigned char mleft, mright;
  55         unsigned char bass, treble;
  56         unsigned char max_bass, max_treble;
  57 };
  58
  59
  60 int snd_tea6330t_detect(struct snd_i2c_bus *bus, int equalizer)
  61 {
  62         int res;
  63
  64         snd_i2c_lock(bus);
  65         res = snd_i2c_probeaddr(bus, TEA6330T_ADDR);
  66         snd_i2c_unlock(bus);
  67         return res;
  68 }
  69
  70 #if 0
  71 static void snd_tea6330t_set(struct tea6330t *tea,
  72                              unsigned char addr, unsigned char value)
  73 {
  74 #if 0
  75         printk(KERN_DEBUG "set - 0x%x/0x%x\n", addr, value);
  76 #endif
  77         snd_i2c_write(tea->bus, TEA6330T_ADDR, addr, value, 1);
  78 }
  79 #endif
  80
  81 #define TEA6330T_MASTER_VOLUME(xname, xindex) \
  82 { .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = xname, .index = xindex, \
  83   .info = snd_tea6330t_info_master_volume, \
  84   .get = snd_tea6330t_get_master_volume, .put = snd_tea6330t_put_master_volume }
  85
  86 static int snd_tea6330t_info_master_volume(struct snd_kcontrol *kcontrol,
  87                                            struct snd_ctl_elem_info *uinfo)
  88 {
  89         uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
  90         uinfo->count = 2;
  91         uinfo->value.integer.min = 0;
  92         uinfo->value.integer.max = 43;
  93         return 0;
  94 }
  95
  96 static int snd_tea6330t_get_master_volume(struct snd_kcontrol *kcontrol,
  97                                           struct snd_ctl_elem_value *ucontrol)
  98 {
  99         struct tea6330t *tea = snd_kcontrol_chip(kcontrol);
 100
 101         snd_i2c_lock(tea->bus);
 102         ucontrol->value.integer.value[0] = tea->mleft - 0x14;
 103         ucontrol->value.integer.value[1] = tea->mright - 0x14;
 104         snd_i2c_unlock(tea->bus);
 105         return 0;
 106 }
 107
 108 static int snd_tea6330t_put_master_volume(struct snd_kcontrol *kcontrol,
 109                                           struct snd_ctl_elem_value *ucontrol)
 110 {
 111         struct tea6330t *tea = snd_kcontrol_chip(kcontrol);
 112         int change, count, err;
 113         unsigned char bytes[3];
 114         unsigned char val1, val2;
 115
 116         val1 = (ucontrol->value.integer.value[0] % 44) + 0x14;
 117         val2 = (ucontrol->value.integer.value[1] % 44) + 0x14;
 118         snd_i2c_lock(tea->bus);
 119         change = val1 != tea->mleft || val2 != tea->mright;
 120         tea->mleft = val1;
 121         tea->mright = val2;
 122         count = 0;
 123         if (tea->regs[TEA6330T_SADDR_VOLUME_LEFT] != 0) {
 124                 bytes[count++] = TEA6330T_SADDR_VOLUME_LEFT;
 125                 bytes[count++] = tea->regs[TEA6330T_SADDR_VOLUME_LEFT] = tea->mleft;
 126         }
 127         if (tea->regs[TEA6330T_SADDR_VOLUME_RIGHT] != 0) {
 128                 if (count == 0)
 129                         bytes[count++] = TEA6330T_SADDR_VOLUME_RIGHT;
 130                 bytes[count++] = tea->regs[TEA6330T_SADDR_VOLUME_RIGHT] = tea->mright;
 131         }
 132         if (count > 0) {
 133                 if ((err = snd_i2c_sendbytes(tea->device, bytes, count)) < 0)
 134                         change = err;
 135         }
 136         snd_i2c_unlock(tea->bus);
 137         return change;
 138 }
 139
 140 #define TEA6330T_MASTER_SWITCH(xname, xindex) \
 141 { .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = xname, .index = xindex, \
 142   .info = snd_tea6330t_info_master_switch, \
 143   .get = snd_tea6330t_get_master_switch, .put = snd_tea6330t_put_master_switch }
 144
 145 static int snd_tea6330t_info_master_switch(struct snd_kcontrol *kcontrol,
 146                                            struct snd_ctl_elem_info *uinfo)
 147 {
 148         uinfo->type = SNDRV_CTL_ELEM_TYPE_BOOLEAN;
 149         uinfo->count = 2;
 150         uinfo->value.integer.min = 0;
 151         uinfo->value.integer.max = 1;
 152         return 0;
 153 }
 154
 155 static int snd_tea6330t_get_master_switch(struct snd_kcontrol *kcontrol,
 156                                           struct snd_ctl_elem_value *ucontrol)
 157 {
 158         struct tea6330t *tea = snd_kcontrol_chip(kcontrol);
 159
 160         snd_i2c_lock(tea->bus);
 161         ucontrol->value.integer.value[0] = tea->regs[TEA6330T_SADDR_VOLUME_LEFT] == 0 ? 0 : 1;
 162         ucontrol->value.integer.value[1] = tea->regs[TEA6330T_SADDR_VOLUME_RIGHT] == 0 ? 0 : 1;
 163         snd_i2c_unlock(tea->bus);
 164         return 0;
 165 }
 166
 167 static int snd_tea6330t_put_master_switch(struct snd_kcontrol *kcontrol,
 168                                           struct snd_ctl_elem_value *ucontrol)
 169 {
 170         struct tea6330t *tea = snd_kcontrol_chip(kcontrol);
 171         int change, err;
 172         unsigned char bytes[3];
 173         unsigned char oval1, oval2, val1, val2;
 174
 175         val1 = ucontrol->value.integer.value[0] & 1;
 176         val2 = ucontrol->value.integer.value[1] & 1;
 177         snd_i2c_lock(tea->bus);
 178         oval1 = tea->regs[TEA6330T_SADDR_VOLUME_LEFT] == 0 ? 0 : 1;
 179         oval2 = tea->regs[TEA6330T_SADDR_VOLUME_RIGHT] == 0 ? 0 : 1;
 180         change = val1 != oval1 || val2 != oval2;
 181         tea->regs[TEA6330T_SADDR_VOLUME_LEFT] = val1 ? tea->mleft : 0;
 182         tea->regs[TEA6330T_SADDR_VOLUME_RIGHT] = val2 ? tea->mright : 0;
 183         bytes[0] = TEA6330T_SADDR_VOLUME_LEFT;
 184         bytes[1] = tea->regs[TEA6330T_SADDR_VOLUME_LEFT];
 185         bytes[2] = tea->regs[TEA6330T_SADDR_VOLUME_RIGHT];
 186         if ((err = snd_i2c_sendbytes(tea->device, bytes, 3)) < 0)
 187                 change = err;
 188         snd_i2c_unlock(tea->bus);
 189         return change;
 190 }
 191
 192 #define TEA6330T_BASS(xname, xindex) \
 193 { .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = xname, .index = xindex, \
 194   .info = snd_tea6330t_info_bass, \
 195   .get = snd_tea6330t_get_bass, .put = snd_tea6330t_put_bass }
 196
 197 static int snd_tea6330t_info_bass(struct snd_kcontrol *kcontrol,
 198                                   struct snd_ctl_elem_info *uinfo)
 199 {
 200         struct tea6330t *tea = snd_kcontrol_chip(kcontrol);
 201
 202         uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
 203         uinfo->count = 1;
 204         uinfo->value.integer.min = 0;
 205         uinfo->value.integer.max = tea->max_bass;
 206         return 0;
 207 }
 208
 209 static int snd_tea6330t_get_bass(struct snd_kcontrol *kcontrol,
 210                                  struct snd_ctl_elem_value *ucontrol)
 211 {
 212         struct tea6330t *tea = snd_kcontrol_chip(kcontrol);
 213
 214         ucontrol->value.integer.value[0] = tea->bass;
 215         return 0;
 216 }
 217
 218 static int snd_tea6330t_put_bass(struct snd_kcontrol *kcontrol,
 219                                  struct snd_ctl_elem_value *ucontrol)
 220 {
 221         struct tea6330t *tea = snd_kcontrol_chip(kcontrol);
 222         int change, err;
 223         unsigned char bytes[2];
 224         unsigned char val1;
 225
 226         val1 = ucontrol->value.integer.value[0] % (tea->max_bass + 1);
 227         snd_i2c_lock(tea->bus);
 228         tea->bass = val1;
 229         val1 += tea->equalizer ? 7 : 3;
 230         change = tea->regs[TEA6330T_SADDR_BASS] != val1;
 231         bytes[0] = TEA6330T_SADDR_BASS;
 232         bytes[1] = tea->regs[TEA6330T_SADDR_BASS] = val1;
 233         if ((err = snd_i2c_sendbytes(tea->device, bytes, 2)) < 0)
 234                 change = err;
 235         snd_i2c_unlock(tea->bus);
 236         return change;
 237 }
 238
 239 #define TEA6330T_TREBLE(xname, xindex) \
 240 { .iface = SNDRV_CTL_ELEM_IFACE_MIXER, .name = xname, .index = xindex, \
 241   .info = snd_tea6330t_info_treble, \
 242   .get = snd_tea6330t_get_treble, .put = snd_tea6330t_put_treble }
 243
 244 static int snd_tea6330t_info_treble(struct snd_kcontrol *kcontrol,
 245                                     struct snd_ctl_elem_info *uinfo)
 246 {
 247         struct tea6330t *tea = snd_kcontrol_chip(kcontrol);
 248
 249         uinfo->type = SNDRV_CTL_ELEM_TYPE_INTEGER;
 250         uinfo->count = 1;
 251         uinfo->value.integer.min = 0;
 252         uinfo->value.integer.max = tea->max_treble;
 253         return 0;
 254 }
 255
 256 static int snd_tea6330t_get_treble(struct snd_kcontrol *kcontrol,
 257                                    struct snd_ctl_elem_value *ucontrol)
 258 {
 259         struct tea6330t *tea = snd_kcontrol_chip(kcontrol);
 260
 261         ucontrol->value.integer.value[0] = tea->treble;
 262         return 0;
 263 }
 264
 265 static int snd_tea6330t_put_treble(struct snd_kcontrol *kcontrol,
 266                                    struct snd_ctl_elem_value *ucontrol)
 267 {
 268         struct tea6330t *tea = snd_kcontrol_chip(kcontrol);
 269         int change, err;
 270         unsigned char bytes[2];
 271         unsigned char val1;
 272
 273         val1 = ucontrol->value.integer.value[0] % (tea->max_treble + 1);
 274         snd_i2c_lock(tea->bus);
 275         tea->treble = val1;
 276         val1 += 3;
 277         change = tea->regs[TEA6330T_SADDR_TREBLE] != val1;
 278         bytes[0] = TEA6330T_SADDR_TREBLE;
 279         bytes[1] = tea->regs[TEA6330T_SADDR_TREBLE] = val1;
 280         if ((err = snd_i2c_sendbytes(tea->device, bytes, 2)) < 0)
 281                 change = err;
 282         snd_i2c_unlock(tea->bus);
 283         return change;
 284 }
 285
 286 static struct snd_kcontrol_new snd_tea6330t_controls[] = {
 287 TEA6330T_MASTER_SWITCH("Master Playback Switch", 0),
 288 TEA6330T_MASTER_VOLUME("Master Playback Volume", 0),
 289 TEA6330T_BASS("Tone Control - Bass", 0),
 290 TEA6330T_TREBLE("Tone Control - Treble", 0)
 291 };
 292
 293 static void snd_tea6330_free(struct snd_i2c_device *device)
 294 {
 295         kfree(device->private_data);
 296 }
 297
 298 int snd_tea6330t_update_mixer(struct snd_card *card,
 299                               struct snd_i2c_bus *bus,
 300                               int equalizer, int fader)
 301 {
 302         struct snd_i2c_device *device;
 303         struct tea6330t *tea;
 304         struct snd_kcontrol_new *knew;
 305         unsigned int idx;
 306         int err = -ENOMEM;
 307         u8 default_treble, default_bass;
 308         unsigned char bytes[7];
 309
 310         tea = kzalloc(sizeof(*tea), GFP_KERNEL);
 311         if (tea == NULL)
 312                 return -ENOMEM;
 313         if ((err = snd_i2c_device_create(bus, "TEA6330T", TEA6330T_ADDR, &device)) < 0) {
 314                 kfree(tea);
 315                 return err;
 316         }
 317         tea->device = device;
 318         tea->bus = bus;
 319         tea->equalizer = equalizer;
 320         tea->fader = fader;
 321         device->private_data = tea;
 322         device->private_free = snd_tea6330_free;
 323
 324         snd_i2c_lock(bus);
 325
 326         /* turn fader off and handle equalizer */
 327         tea->regs[TEA6330T_SADDR_FADER] = 0x3f;
 328         tea->regs[TEA6330T_SADDR_AUDIO_SWITCH] = equalizer ? 0 : TEA6330T_EQN;
 329         /* initialize mixer */
 330         if (!tea->equalizer) {
 331                 tea->max_bass = 9;
 332                 tea->max_treble = 8;
 333                 default_bass = 3 + 4;
 334                 tea->bass = 4;
 335                 default_treble = 3 + 4;
 336                 tea->treble = 4;
 337         } else {
 338                 tea->max_bass = 5;
 339                 tea->max_treble = 0;
 340                 default_bass = 7 + 4;
 341                 tea->bass = 4;
 342                 default_treble = 3;
 343                 tea->treble = 0;
 344         }
 345         tea->mleft = tea->mright = 0x14;
 346         tea->regs[TEA6330T_SADDR_BASS] = default_bass;
 347         tea->regs[TEA6330T_SADDR_TREBLE] = default_treble;
 348
 349         /* compose I2C message and put the hardware to initial state */
 350         bytes[0] = TEA6330T_SADDR_VOLUME_LEFT;
 351         for (idx = 0; idx < 6; idx++)
 352                 bytes[idx+1] = tea->regs[idx];
 353         if ((err = snd_i2c_sendbytes(device, bytes, 7)) < 0)
 354                 goto __error;
 355
 356         strcat(card->mixername, ",TEA6330T");
 357         if ((err = snd_component_add(card, "TEA6330T")) < 0)
 358                 goto __error;
 359
 360         for (idx = 0; idx < ARRAY_SIZE(snd_tea6330t_controls); idx++) {
 361                 knew = &snd_tea6330t_controls[idx];
 362                 if (tea->treble == 0 && !strcmp(knew->name, "Tone Control - Treble"))
 363                         continue;
 364                 if ((err = snd_ctl_add(card, snd_ctl_new1(knew, tea))) < 0)
 365                         goto __error;
 366         }
 367
 368         snd_i2c_unlock(bus);
 369         return 0;
 370
 371       __error:
 372         snd_i2c_unlock(bus);
 373         snd_i2c_device_free(device);
 374         return err;
 375 }
 376
 377 EXPORT_SYMBOL(snd_tea6330t_detect);
 378 EXPORT_SYMBOL(snd_tea6330t_update_mixer);
 379
 380 /*
 381  *  INIT part
 382  */
 383
 384 static int __init alsa_tea6330t_init(void)
 385 {
 386         return 0;
 387 }
 388
 389 static void __exit alsa_tea6330t_exit(void)
 390 {
 391 }
 392
 393 module_init(alsa_tea6330t_init)
 394 module_exit(alsa_tea6330t_exit)