linux/sound/i2c/tea6330t.c
<<
>>
Prefs
   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
  15MODULE_AUTHOR("Jaroslav Kysela <perex@perex.cz>");
  16MODULE_DESCRIPTION("Routines for control of the TEA6330T circuit via i2c bus");
  17MODULE_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
  33struct 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
  45int 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
  56static 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
  71static 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
  81static 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
  93static 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
 133static 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
 145static 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
 176static 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
 188static 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
 197static 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
 224static 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
 236static 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
 245static 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
 267static const struct snd_kcontrol_new snd_tea6330t_controls[] = {
 268TEA6330T_MASTER_SWITCH("Master Playback Switch", 0),
 269TEA6330T_MASTER_VOLUME("Master Playback Volume", 0),
 270TEA6330T_BASS("Tone Control - Bass", 0),
 271TEA6330T_TREBLE("Tone Control - Treble", 0)
 272};
 273
 274static void snd_tea6330_free(struct snd_i2c_device *device)
 275{
 276        kfree(device->private_data);
 277}
 278                                        
 279int 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
 362EXPORT_SYMBOL(snd_tea6330t_detect);
 363EXPORT_SYMBOL(snd_tea6330t_update_mixer);
 364