sound/i2c/tea6330t.c

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