sound/pci/lola/lola_clock.c

   1 // SPDX-License-Identifier: GPL-2.0-or-later
   2 /*
   3  *  Support for Digigram Lola PCI-e boards
   4  *
   5  *  Copyright (c) 2011 Takashi Iwai <tiwai@suse.de>
   6  */
   7
   8 #include <linux/kernel.h>
   9 #include <linux/init.h>
  10 #include <linux/delay.h>
  11 #include <sound/core.h>
  12 #include <sound/pcm.h>
  13 #include "lola.h"
  14
  15 unsigned int lola_sample_rate_convert(unsigned int coded)
  16 {
  17         unsigned int freq;
  18
  19         /* base frequency */
  20         switch (coded & 0x3) {
  21         case 0:     freq = 48000; break;
  22         case 1:     freq = 44100; break;
  23         case 2:     freq = 32000; break;
  24         default:    return 0;   /* error */
  25         }
  26
  27         /* multiplier / devisor */
  28         switch (coded & 0x1c) {
  29         case (0 << 2):    break;
  30         case (4 << 2):    break;
  31         case (1 << 2):    freq *= 2; break;
  32         case (2 << 2):    freq *= 4; break;
  33         case (5 << 2):    freq /= 2; break;
  34         case (6 << 2):    freq /= 4; break;
  35         default:        return 0;   /* error */
  36         }
  37
  38         /* ajustement */
  39         switch (coded & 0x60) {
  40         case (0 << 5):    break;
  41         case (1 << 5):    freq = (freq * 999) / 1000; break;
  42         case (2 << 5):    freq = (freq * 1001) / 1000; break;
  43         default:        return 0;   /* error */
  44         }
  45         return freq;
  46 }
  47
  48 /*
  49  * Granualrity
  50  */
  51
  52 #define LOLA_MAXFREQ_AT_GRANULARITY_MIN         48000
  53 #define LOLA_MAXFREQ_AT_GRANULARITY_BELOW_MAX   96000
  54
  55 static bool check_gran_clock_compatibility(struct lola *chip,
  56                                            unsigned int val,
  57                                            unsigned int freq)
  58 {
  59         if (!chip->granularity)
  60                 return true;
  61
  62         if (val < LOLA_GRANULARITY_MIN || val > LOLA_GRANULARITY_MAX ||
  63             (val % LOLA_GRANULARITY_STEP) != 0)
  64                 return false;
  65
  66         if (val == LOLA_GRANULARITY_MIN) {
  67                 if (freq > LOLA_MAXFREQ_AT_GRANULARITY_MIN)
  68                         return false;
  69         } else if (val < LOLA_GRANULARITY_MAX) {
  70                 if (freq > LOLA_MAXFREQ_AT_GRANULARITY_BELOW_MAX)
  71                         return false;
  72         }
  73         return true;
  74 }
  75
  76 int lola_set_granularity(struct lola *chip, unsigned int val, bool force)
  77 {
  78         int err;
  79
  80         if (!force) {
  81                 if (val == chip->granularity)
  82                         return 0;
  83 #if 0
  84                 /* change Gran only if there are no streams allocated ! */
  85                 if (chip->audio_in_alloc_mask || chip->audio_out_alloc_mask)
  86                         return -EBUSY;
  87 #endif
  88                 if (!check_gran_clock_compatibility(chip, val,
  89                                                     chip->clock.cur_freq))
  90                         return -EINVAL;
  91         }
  92
  93         chip->granularity = val;
  94         val /= LOLA_GRANULARITY_STEP;
  95
  96         /* audio function group */
  97         err = lola_codec_write(chip, 1, LOLA_VERB_SET_GRANULARITY_STEPS,
  98                                val, 0);
  99         if (err < 0)
 100                 return err;
 101         /* this can be a very slow function !!! */
 102         usleep_range(400 * val, 20000);
 103         return lola_codec_flush(chip);
 104 }
 105
 106 /*
 107  * Clock widget handling
 108  */
 109
 110 int lola_init_clock_widget(struct lola *chip, int nid)
 111 {
 112         unsigned int val;
 113         int i, j, nitems, nb_verbs, idx, idx_list;
 114         int err;
 115
 116         err = lola_read_param(chip, nid, LOLA_PAR_AUDIO_WIDGET_CAP, &val);
 117         if (err < 0) {
 118                 dev_err(chip->card->dev, "Can't read wcaps for 0x%x\n", nid);
 119                 return err;
 120         }
 121
 122         if ((val & 0xfff00000) != 0x01f00000) { /* test SubType and Type */
 123                 dev_dbg(chip->card->dev, "No valid clock widget\n");
 124                 return 0;
 125         }
 126
 127         chip->clock.nid = nid;
 128         chip->clock.items = val & 0xff;
 129         dev_dbg(chip->card->dev, "clock_list nid=%x, entries=%d\n", nid,
 130                     chip->clock.items);
 131         if (chip->clock.items > MAX_SAMPLE_CLOCK_COUNT) {
 132                 dev_err(chip->card->dev, "CLOCK_LIST too big: %d\n",
 133                        chip->clock.items);
 134                 return -EINVAL;
 135         }
 136
 137         nitems = chip->clock.items;
 138         nb_verbs = DIV_ROUND_UP(nitems, 4);
 139         idx = 0;
 140         idx_list = 0;
 141         for (i = 0; i < nb_verbs; i++) {
 142                 unsigned int res_ex;
 143                 unsigned short items[4];
 144
 145                 err = lola_codec_read(chip, nid, LOLA_VERB_GET_CLOCK_LIST,
 146                                       idx, 0, &val, &res_ex);
 147                 if (err < 0) {
 148                         dev_err(chip->card->dev, "Can't read CLOCK_LIST\n");
 149                         return -EINVAL;
 150                 }
 151
 152                 items[0] = val & 0xfff;
 153                 items[1] = (val >> 16) & 0xfff;
 154                 items[2] = res_ex & 0xfff;
 155                 items[3] = (res_ex >> 16) & 0xfff;
 156
 157                 for (j = 0; j < 4; j++) {
 158                         unsigned char type = items[j] >> 8;
 159                         unsigned int freq = items[j] & 0xff;
 160                         int format = LOLA_CLOCK_FORMAT_NONE;
 161                         bool add_clock = true;
 162                         if (type == LOLA_CLOCK_TYPE_INTERNAL) {
 163                                 freq = lola_sample_rate_convert(freq);
 164                                 if (freq < chip->sample_rate_min)
 165                                         add_clock = false;
 166                                 else if (freq == 48000) {
 167                                         chip->clock.cur_index = idx_list;
 168                                         chip->clock.cur_freq = 48000;
 169                                         chip->clock.cur_valid = true;
 170                                 }
 171                         } else if (type == LOLA_CLOCK_TYPE_VIDEO) {
 172                                 freq = lola_sample_rate_convert(freq);
 173                                 if (freq < chip->sample_rate_min)
 174                                         add_clock = false;
 175                                 /* video clock has a format (0:NTSC, 1:PAL)*/
 176                                 if (items[j] & 0x80)
 177                                         format = LOLA_CLOCK_FORMAT_NTSC;
 178                                 else
 179                                         format = LOLA_CLOCK_FORMAT_PAL;
 180                         }
 181                         if (add_clock) {
 182                                 struct lola_sample_clock *sc;
 183                                 sc = &chip->clock.sample_clock[idx_list];
 184                                 sc->type = type;
 185                                 sc->format = format;
 186                                 sc->freq = freq;
 187                                 /* keep the index used with the board */
 188                                 chip->clock.idx_lookup[idx_list] = idx;
 189                                 idx_list++;
 190                         } else {
 191                                 chip->clock.items--;
 192                         }
 193                         if (++idx >= nitems)
 194                                 break;
 195                 }
 196         }
 197         return 0;
 198 }
 199
 200 /* enable unsolicited events of the clock widget */
 201 int lola_enable_clock_events(struct lola *chip)
 202 {
 203         unsigned int res;
 204         int err;
 205
 206         err = lola_codec_read(chip, chip->clock.nid,
 207                               LOLA_VERB_SET_UNSOLICITED_ENABLE,
 208                               LOLA_UNSOLICITED_ENABLE | LOLA_UNSOLICITED_TAG,
 209                               0, &res, NULL);
 210         if (err < 0)
 211                 return err;
 212         if (res) {
 213                 dev_warn(chip->card->dev, "error in enable_clock_events %d\n",
 214                        res);
 215                 return -EINVAL;
 216         }
 217         return 0;
 218 }
 219
 220 int lola_set_clock_index(struct lola *chip, unsigned int idx)
 221 {
 222         unsigned int res;
 223         int err;
 224
 225         err = lola_codec_read(chip, chip->clock.nid,
 226                               LOLA_VERB_SET_CLOCK_SELECT,
 227                               chip->clock.idx_lookup[idx],
 228                               0, &res, NULL);
 229         if (err < 0)
 230                 return err;
 231         if (res) {
 232                 dev_warn(chip->card->dev, "error in set_clock %d\n", res);
 233                 return -EINVAL;
 234         }
 235         return 0;
 236 }
 237
 238 bool lola_update_ext_clock_freq(struct lola *chip, unsigned int val)
 239 {
 240         unsigned int tag;
 241
 242         /* the current EXTERNAL clock information gets updated by interrupt
 243          * with an unsolicited response
 244          */
 245         if (!val)
 246                 return false;
 247         tag = (val >> LOLA_UNSOL_RESP_TAG_OFFSET) & LOLA_UNSOLICITED_TAG_MASK;
 248         if (tag != LOLA_UNSOLICITED_TAG)
 249                 return false;
 250
 251         /* only for current = external clocks */
 252         if (chip->clock.sample_clock[chip->clock.cur_index].type !=
 253             LOLA_CLOCK_TYPE_INTERNAL) {
 254                 chip->clock.cur_freq = lola_sample_rate_convert(val & 0x7f);
 255                 chip->clock.cur_valid = (val & 0x100) != 0;
 256         }
 257         return true;
 258 }
 259
 260 int lola_set_clock(struct lola *chip, int idx)
 261 {
 262         int freq = 0;
 263         bool valid = false;
 264
 265         if (idx == chip->clock.cur_index) {
 266                 /* current clock is allowed */
 267                 freq = chip->clock.cur_freq;
 268                 valid = chip->clock.cur_valid;
 269         } else if (chip->clock.sample_clock[idx].type ==
 270                    LOLA_CLOCK_TYPE_INTERNAL) {
 271                 /* internal clocks allowed */
 272                 freq = chip->clock.sample_clock[idx].freq;
 273                 valid = true;
 274         }
 275
 276         if (!freq || !valid)
 277                 return -EINVAL;
 278
 279         if (!check_gran_clock_compatibility(chip, chip->granularity, freq))
 280                 return -EINVAL;
 281
 282         if (idx != chip->clock.cur_index) {
 283                 int err = lola_set_clock_index(chip, idx);
 284                 if (err < 0)
 285                         return err;
 286                 /* update new settings */
 287                 chip->clock.cur_index = idx;
 288                 chip->clock.cur_freq = freq;
 289                 chip->clock.cur_valid = true;
 290         }
 291         return 0;
 292 }
 293
 294 int lola_set_sample_rate(struct lola *chip, int rate)
 295 {
 296         int i;
 297
 298         if (chip->clock.cur_freq == rate && chip->clock.cur_valid)
 299                 return 0;
 300         /* search for new dwClockIndex */
 301         for (i = 0; i < chip->clock.items; i++) {
 302                 if (chip->clock.sample_clock[i].type == LOLA_CLOCK_TYPE_INTERNAL &&
 303                     chip->clock.sample_clock[i].freq == rate)
 304                         break;
 305         }
 306         if (i >= chip->clock.items)
 307                 return -EINVAL;
 308         return lola_set_clock(chip, i);
 309 }
 310