123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324 |
- #include <linux/kernel.h>
- #include <linux/init.h>
- #include <linux/delay.h>
- #include <sound/core.h>
- #include <sound/pcm.h>
- #include "lola.h"
- unsigned int lola_sample_rate_convert(unsigned int coded)
- {
- unsigned int freq;
-
- switch (coded & 0x3) {
- case 0: freq = 48000; break;
- case 1: freq = 44100; break;
- case 2: freq = 32000; break;
- default: return 0;
- }
-
- switch (coded & 0x1c) {
- case (0 << 2): break;
- case (4 << 2): break;
- case (1 << 2): freq *= 2; break;
- case (2 << 2): freq *= 4; break;
- case (5 << 2): freq /= 2; break;
- case (6 << 2): freq /= 4; break;
- default: return 0;
- }
-
- switch (coded & 0x60) {
- case (0 << 5): break;
- case (1 << 5): freq = (freq * 999) / 1000; break;
- case (2 << 5): freq = (freq * 1001) / 1000; break;
- default: return 0;
- }
- return freq;
- }
- #define LOLA_MAXFREQ_AT_GRANULARITY_MIN 48000
- #define LOLA_MAXFREQ_AT_GRANULARITY_BELOW_MAX 96000
- static bool check_gran_clock_compatibility(struct lola *chip,
- unsigned int val,
- unsigned int freq)
- {
- if (!chip->granularity)
- return true;
- if (val < LOLA_GRANULARITY_MIN || val > LOLA_GRANULARITY_MAX ||
- (val % LOLA_GRANULARITY_STEP) != 0)
- return false;
- if (val == LOLA_GRANULARITY_MIN) {
- if (freq > LOLA_MAXFREQ_AT_GRANULARITY_MIN)
- return false;
- } else if (val < LOLA_GRANULARITY_MAX) {
- if (freq > LOLA_MAXFREQ_AT_GRANULARITY_BELOW_MAX)
- return false;
- }
- return true;
- }
- int lola_set_granularity(struct lola *chip, unsigned int val, bool force)
- {
- int err;
- if (!force) {
- if (val == chip->granularity)
- return 0;
- #if 0
-
- if (chip->audio_in_alloc_mask || chip->audio_out_alloc_mask)
- return -EBUSY;
- #endif
- if (!check_gran_clock_compatibility(chip, val,
- chip->clock.cur_freq))
- return -EINVAL;
- }
- chip->granularity = val;
- val /= LOLA_GRANULARITY_STEP;
-
- err = lola_codec_write(chip, 1, LOLA_VERB_SET_GRANULARITY_STEPS,
- val, 0);
- if (err < 0)
- return err;
-
- usleep_range(400 * val, 20000);
- return lola_codec_flush(chip);
- }
- int lola_init_clock_widget(struct lola *chip, int nid)
- {
- unsigned int val;
- int i, j, nitems, nb_verbs, idx, idx_list;
- int err;
- err = lola_read_param(chip, nid, LOLA_PAR_AUDIO_WIDGET_CAP, &val);
- if (err < 0) {
- dev_err(chip->card->dev, "Can't read wcaps for 0x%x\n", nid);
- return err;
- }
- if ((val & 0xfff00000) != 0x01f00000) {
- dev_dbg(chip->card->dev, "No valid clock widget\n");
- return 0;
- }
- chip->clock.nid = nid;
- chip->clock.items = val & 0xff;
- dev_dbg(chip->card->dev, "clock_list nid=%x, entries=%d\n", nid,
- chip->clock.items);
- if (chip->clock.items > MAX_SAMPLE_CLOCK_COUNT) {
- dev_err(chip->card->dev, "CLOCK_LIST too big: %d\n",
- chip->clock.items);
- return -EINVAL;
- }
- nitems = chip->clock.items;
- nb_verbs = (nitems + 3) / 4;
- idx = 0;
- idx_list = 0;
- for (i = 0; i < nb_verbs; i++) {
- unsigned int res_ex;
- unsigned short items[4];
- err = lola_codec_read(chip, nid, LOLA_VERB_GET_CLOCK_LIST,
- idx, 0, &val, &res_ex);
- if (err < 0) {
- dev_err(chip->card->dev, "Can't read CLOCK_LIST\n");
- return -EINVAL;
- }
- items[0] = val & 0xfff;
- items[1] = (val >> 16) & 0xfff;
- items[2] = res_ex & 0xfff;
- items[3] = (res_ex >> 16) & 0xfff;
- for (j = 0; j < 4; j++) {
- unsigned char type = items[j] >> 8;
- unsigned int freq = items[j] & 0xff;
- int format = LOLA_CLOCK_FORMAT_NONE;
- bool add_clock = true;
- if (type == LOLA_CLOCK_TYPE_INTERNAL) {
- freq = lola_sample_rate_convert(freq);
- if (freq < chip->sample_rate_min)
- add_clock = false;
- else if (freq == 48000) {
- chip->clock.cur_index = idx_list;
- chip->clock.cur_freq = 48000;
- chip->clock.cur_valid = true;
- }
- } else if (type == LOLA_CLOCK_TYPE_VIDEO) {
- freq = lola_sample_rate_convert(freq);
- if (freq < chip->sample_rate_min)
- add_clock = false;
-
- if (items[j] & 0x80)
- format = LOLA_CLOCK_FORMAT_NTSC;
- else
- format = LOLA_CLOCK_FORMAT_PAL;
- }
- if (add_clock) {
- struct lola_sample_clock *sc;
- sc = &chip->clock.sample_clock[idx_list];
- sc->type = type;
- sc->format = format;
- sc->freq = freq;
-
- chip->clock.idx_lookup[idx_list] = idx;
- idx_list++;
- } else {
- chip->clock.items--;
- }
- if (++idx >= nitems)
- break;
- }
- }
- return 0;
- }
- int lola_enable_clock_events(struct lola *chip)
- {
- unsigned int res;
- int err;
- err = lola_codec_read(chip, chip->clock.nid,
- LOLA_VERB_SET_UNSOLICITED_ENABLE,
- LOLA_UNSOLICITED_ENABLE | LOLA_UNSOLICITED_TAG,
- 0, &res, NULL);
- if (err < 0)
- return err;
- if (res) {
- dev_warn(chip->card->dev, "error in enable_clock_events %d\n",
- res);
- return -EINVAL;
- }
- return 0;
- }
- int lola_set_clock_index(struct lola *chip, unsigned int idx)
- {
- unsigned int res;
- int err;
- err = lola_codec_read(chip, chip->clock.nid,
- LOLA_VERB_SET_CLOCK_SELECT,
- chip->clock.idx_lookup[idx],
- 0, &res, NULL);
- if (err < 0)
- return err;
- if (res) {
- dev_warn(chip->card->dev, "error in set_clock %d\n", res);
- return -EINVAL;
- }
- return 0;
- }
- bool lola_update_ext_clock_freq(struct lola *chip, unsigned int val)
- {
- unsigned int tag;
-
- if (!val)
- return false;
- tag = (val >> LOLA_UNSOL_RESP_TAG_OFFSET) & LOLA_UNSOLICITED_TAG_MASK;
- if (tag != LOLA_UNSOLICITED_TAG)
- return false;
-
- if (chip->clock.sample_clock[chip->clock.cur_index].type !=
- LOLA_CLOCK_TYPE_INTERNAL) {
- chip->clock.cur_freq = lola_sample_rate_convert(val & 0x7f);
- chip->clock.cur_valid = (val & 0x100) != 0;
- }
- return true;
- }
- int lola_set_clock(struct lola *chip, int idx)
- {
- int freq = 0;
- bool valid = false;
- if (idx == chip->clock.cur_index) {
-
- freq = chip->clock.cur_freq;
- valid = chip->clock.cur_valid;
- } else if (chip->clock.sample_clock[idx].type ==
- LOLA_CLOCK_TYPE_INTERNAL) {
-
- freq = chip->clock.sample_clock[idx].freq;
- valid = true;
- }
- if (!freq || !valid)
- return -EINVAL;
- if (!check_gran_clock_compatibility(chip, chip->granularity, freq))
- return -EINVAL;
- if (idx != chip->clock.cur_index) {
- int err = lola_set_clock_index(chip, idx);
- if (err < 0)
- return err;
-
- chip->clock.cur_index = idx;
- chip->clock.cur_freq = freq;
- chip->clock.cur_valid = true;
- }
- return 0;
- }
- int lola_set_sample_rate(struct lola *chip, int rate)
- {
- int i;
- if (chip->clock.cur_freq == rate && chip->clock.cur_valid)
- return 0;
-
- for (i = 0; i < chip->clock.items; i++) {
- if (chip->clock.sample_clock[i].type == LOLA_CLOCK_TYPE_INTERNAL &&
- chip->clock.sample_clock[i].freq == rate)
- break;
- }
- if (i >= chip->clock.items)
- return -EINVAL;
- return lola_set_clock(chip, i);
- }
|