311 lines · c
1// SPDX-License-Identifier: GPL-2.0-or-later2/*3 * Support for Digigram Lola PCI-e boards4 *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 15unsigned 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 * Granualrity50 */51 52#define LOLA_MAXFREQ_AT_GRANULARITY_MIN 4800053#define LOLA_MAXFREQ_AT_GRANULARITY_BELOW_MAX 9600054 55static 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 76int 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 084 /* 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#endif88 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 handling108 */109 110int 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 else179 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 */201int 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 220int 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 238bool 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 interrupt243 * with an unsolicited response244 */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 260int 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 294int 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 311