123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562 |
- #include <linux/init.h>
- #include <linux/sched.h>
- #include <linux/errno.h>
- #include <sound/core.h>
- #include <sound/pcm.h>
- #include <sound/ad1843.h>
- struct ad1843_bitfield {
- char reg;
- char lo_bit;
- char nbits;
- };
- static const struct ad1843_bitfield
- ad1843_PDNO = { 0, 14, 1 },
- ad1843_INIT = { 0, 15, 1 },
- ad1843_RIG = { 2, 0, 4 },
- ad1843_RMGE = { 2, 4, 1 },
- ad1843_RSS = { 2, 5, 3 },
- ad1843_LIG = { 2, 8, 4 },
- ad1843_LMGE = { 2, 12, 1 },
- ad1843_LSS = { 2, 13, 3 },
- ad1843_RD2M = { 3, 0, 5 },
- ad1843_RD2MM = { 3, 7, 1 },
- ad1843_LD2M = { 3, 8, 5 },
- ad1843_LD2MM = { 3, 15, 1 },
- ad1843_RX1M = { 4, 0, 5 },
- ad1843_RX1MM = { 4, 7, 1 },
- ad1843_LX1M = { 4, 8, 5 },
- ad1843_LX1MM = { 4, 15, 1 },
- ad1843_RX2M = { 5, 0, 5 },
- ad1843_RX2MM = { 5, 7, 1 },
- ad1843_LX2M = { 5, 8, 5 },
- ad1843_LX2MM = { 5, 15, 1 },
- ad1843_RMCM = { 7, 0, 5 },
- ad1843_RMCMM = { 7, 7, 1 },
- ad1843_LMCM = { 7, 8, 5 },
- ad1843_LMCMM = { 7, 15, 1 },
- ad1843_HPOS = { 8, 4, 1 },
- ad1843_HPOM = { 8, 5, 1 },
- ad1843_MPOM = { 8, 6, 1 },
- ad1843_RDA1G = { 9, 0, 6 },
- ad1843_RDA1GM = { 9, 7, 1 },
- ad1843_LDA1G = { 9, 8, 6 },
- ad1843_LDA1GM = { 9, 15, 1 },
- ad1843_RDA2G = { 10, 0, 6 },
- ad1843_RDA2GM = { 10, 7, 1 },
- ad1843_LDA2G = { 10, 8, 6 },
- ad1843_LDA2GM = { 10, 15, 1 },
- ad1843_RDA1AM = { 11, 7, 1 },
- ad1843_LDA1AM = { 11, 15, 1 },
- ad1843_RDA2AM = { 12, 7, 1 },
- ad1843_LDA2AM = { 12, 15, 1 },
- ad1843_ADLC = { 15, 0, 2 },
- ad1843_ADRC = { 15, 2, 2 },
- ad1843_DA1C = { 15, 8, 2 },
- ad1843_DA2C = { 15, 10, 2 },
- ad1843_C1C = { 17, 0, 16 },
- ad1843_C2C = { 20, 0, 16 },
- ad1843_C3C = { 23, 0, 16 },
- ad1843_DAADL = { 25, 4, 2 },
- ad1843_DAADR = { 25, 6, 2 },
- ad1843_DAMIX = { 25, 14, 1 },
- ad1843_DRSFLT = { 25, 15, 1 },
- ad1843_ADLF = { 26, 0, 2 },
- ad1843_ADRF = { 26, 2, 2 },
- ad1843_ADTLK = { 26, 4, 1 },
- ad1843_SCF = { 26, 7, 1 },
- ad1843_DA1F = { 26, 8, 2 },
- ad1843_DA2F = { 26, 10, 2 },
- ad1843_DA1SM = { 26, 14, 1 },
- ad1843_DA2SM = { 26, 15, 1 },
- ad1843_ADLEN = { 27, 0, 1 },
- ad1843_ADREN = { 27, 1, 1 },
- ad1843_AAMEN = { 27, 4, 1 },
- ad1843_ANAEN = { 27, 7, 1 },
- ad1843_DA1EN = { 27, 8, 1 },
- ad1843_DA2EN = { 27, 9, 1 },
- ad1843_DDMEN = { 27, 12, 1 },
- ad1843_C1EN = { 28, 11, 1 },
- ad1843_C2EN = { 28, 12, 1 },
- ad1843_C3EN = { 28, 13, 1 },
- ad1843_PDNI = { 28, 15, 1 };
- struct ad1843_gain {
- int negative;
- const struct ad1843_bitfield *lfield;
- const struct ad1843_bitfield *rfield;
- const struct ad1843_bitfield *lmute;
- const struct ad1843_bitfield *rmute;
- };
- static const struct ad1843_gain ad1843_gain_RECLEV = {
- .negative = 0,
- .lfield = &ad1843_LIG,
- .rfield = &ad1843_RIG
- };
- static const struct ad1843_gain ad1843_gain_LINE = {
- .negative = 1,
- .lfield = &ad1843_LX1M,
- .rfield = &ad1843_RX1M,
- .lmute = &ad1843_LX1MM,
- .rmute = &ad1843_RX1MM
- };
- static const struct ad1843_gain ad1843_gain_LINE_2 = {
- .negative = 1,
- .lfield = &ad1843_LDA2G,
- .rfield = &ad1843_RDA2G,
- .lmute = &ad1843_LDA2GM,
- .rmute = &ad1843_RDA2GM
- };
- static const struct ad1843_gain ad1843_gain_MIC = {
- .negative = 1,
- .lfield = &ad1843_LMCM,
- .rfield = &ad1843_RMCM,
- .lmute = &ad1843_LMCMM,
- .rmute = &ad1843_RMCMM
- };
- static const struct ad1843_gain ad1843_gain_PCM_0 = {
- .negative = 1,
- .lfield = &ad1843_LDA1G,
- .rfield = &ad1843_RDA1G,
- .lmute = &ad1843_LDA1GM,
- .rmute = &ad1843_RDA1GM
- };
- static const struct ad1843_gain ad1843_gain_PCM_1 = {
- .negative = 1,
- .lfield = &ad1843_LD2M,
- .rfield = &ad1843_RD2M,
- .lmute = &ad1843_LD2MM,
- .rmute = &ad1843_RD2MM
- };
- static const struct ad1843_gain *ad1843_gain[AD1843_GAIN_SIZE] =
- {
- &ad1843_gain_RECLEV,
- &ad1843_gain_LINE,
- &ad1843_gain_LINE_2,
- &ad1843_gain_MIC,
- &ad1843_gain_PCM_0,
- &ad1843_gain_PCM_1,
- };
- static int ad1843_read_bits(struct snd_ad1843 *ad1843,
- const struct ad1843_bitfield *field)
- {
- int w;
- w = ad1843->read(ad1843->chip, field->reg);
- return w >> field->lo_bit & ((1 << field->nbits) - 1);
- }
- static int ad1843_write_bits(struct snd_ad1843 *ad1843,
- const struct ad1843_bitfield *field,
- int newval)
- {
- int w, mask, oldval, newbits;
- w = ad1843->read(ad1843->chip, field->reg);
- mask = ((1 << field->nbits) - 1) << field->lo_bit;
- oldval = (w & mask) >> field->lo_bit;
- newbits = (newval << field->lo_bit) & mask;
- w = (w & ~mask) | newbits;
- ad1843->write(ad1843->chip, field->reg, w);
- return oldval;
- }
- static void ad1843_read_multi(struct snd_ad1843 *ad1843, int argcount, ...)
- {
- va_list ap;
- const struct ad1843_bitfield *fp;
- int w = 0, mask, *value, reg = -1;
- va_start(ap, argcount);
- while (--argcount >= 0) {
- fp = va_arg(ap, const struct ad1843_bitfield *);
- value = va_arg(ap, int *);
- if (reg == -1) {
- reg = fp->reg;
- w = ad1843->read(ad1843->chip, reg);
- }
- mask = (1 << fp->nbits) - 1;
- *value = w >> fp->lo_bit & mask;
- }
- va_end(ap);
- }
- static void ad1843_write_multi(struct snd_ad1843 *ad1843, int argcount, ...)
- {
- va_list ap;
- int reg;
- const struct ad1843_bitfield *fp;
- int value;
- int w, m, mask, bits;
- mask = 0;
- bits = 0;
- reg = -1;
- va_start(ap, argcount);
- while (--argcount >= 0) {
- fp = va_arg(ap, const struct ad1843_bitfield *);
- value = va_arg(ap, int);
- if (reg == -1)
- reg = fp->reg;
- else
- WARN_ON(reg != fp->reg);
- m = ((1 << fp->nbits) - 1) << fp->lo_bit;
- mask |= m;
- bits |= (value << fp->lo_bit) & m;
- }
- va_end(ap);
- if (~mask & 0xFFFF)
- w = ad1843->read(ad1843->chip, reg);
- else
- w = 0;
- w = (w & ~mask) | bits;
- ad1843->write(ad1843->chip, reg, w);
- }
- int ad1843_get_gain_max(struct snd_ad1843 *ad1843, int id)
- {
- const struct ad1843_gain *gp = ad1843_gain[id];
- int ret;
- ret = (1 << gp->lfield->nbits);
- if (!gp->lmute)
- ret -= 1;
- return ret;
- }
- int ad1843_get_gain(struct snd_ad1843 *ad1843, int id)
- {
- int lg, rg, lm, rm;
- const struct ad1843_gain *gp = ad1843_gain[id];
- unsigned short mask = (1 << gp->lfield->nbits) - 1;
- ad1843_read_multi(ad1843, 2, gp->lfield, &lg, gp->rfield, &rg);
- if (gp->negative) {
- lg = mask - lg;
- rg = mask - rg;
- }
- if (gp->lmute) {
- ad1843_read_multi(ad1843, 2, gp->lmute, &lm, gp->rmute, &rm);
- if (lm)
- lg = 0;
- if (rm)
- rg = 0;
- }
- return lg << 0 | rg << 8;
- }
- int ad1843_set_gain(struct snd_ad1843 *ad1843, int id, int newval)
- {
- const struct ad1843_gain *gp = ad1843_gain[id];
- unsigned short mask = (1 << gp->lfield->nbits) - 1;
- int lg = (newval >> 0) & mask;
- int rg = (newval >> 8) & mask;
- int lm = (lg == 0) ? 1 : 0;
- int rm = (rg == 0) ? 1 : 0;
- if (gp->negative) {
- lg = mask - lg;
- rg = mask - rg;
- }
- if (gp->lmute)
- ad1843_write_multi(ad1843, 2, gp->lmute, lm, gp->rmute, rm);
- ad1843_write_multi(ad1843, 2, gp->lfield, lg, gp->rfield, rg);
- return ad1843_get_gain(ad1843, id);
- }
- int ad1843_get_recsrc(struct snd_ad1843 *ad1843)
- {
- int val = ad1843_read_bits(ad1843, &ad1843_LSS);
- if (val < 0 || val > 2) {
- val = 2;
- ad1843_write_multi(ad1843, 2,
- &ad1843_LSS, val, &ad1843_RSS, val);
- }
- return val;
- }
- int ad1843_set_recsrc(struct snd_ad1843 *ad1843, int newsrc)
- {
- if (newsrc < 0 || newsrc > 2)
- return -EINVAL;
- ad1843_write_multi(ad1843, 2, &ad1843_LSS, newsrc, &ad1843_RSS, newsrc);
- return newsrc;
- }
- void ad1843_setup_dac(struct snd_ad1843 *ad1843,
- unsigned int id,
- unsigned int framerate,
- snd_pcm_format_t fmt,
- unsigned int channels)
- {
- int ad_fmt = 0, ad_mode = 0;
- switch (fmt) {
- case SNDRV_PCM_FORMAT_S8:
- ad_fmt = 0;
- break;
- case SNDRV_PCM_FORMAT_U8:
- ad_fmt = 0;
- break;
- case SNDRV_PCM_FORMAT_S16_LE:
- ad_fmt = 1;
- break;
- case SNDRV_PCM_FORMAT_MU_LAW:
- ad_fmt = 2;
- break;
- case SNDRV_PCM_FORMAT_A_LAW:
- ad_fmt = 3;
- break;
- default:
- break;
- }
- switch (channels) {
- case 2:
- ad_mode = 0;
- break;
- case 1:
- ad_mode = 1;
- break;
- default:
- break;
- }
- if (id) {
- ad1843_write_bits(ad1843, &ad1843_C2C, framerate);
- ad1843_write_multi(ad1843, 2,
- &ad1843_DA2SM, ad_mode,
- &ad1843_DA2F, ad_fmt);
- } else {
- ad1843_write_bits(ad1843, &ad1843_C1C, framerate);
- ad1843_write_multi(ad1843, 2,
- &ad1843_DA1SM, ad_mode,
- &ad1843_DA1F, ad_fmt);
- }
- }
- void ad1843_shutdown_dac(struct snd_ad1843 *ad1843, unsigned int id)
- {
- if (id)
- ad1843_write_bits(ad1843, &ad1843_DA2F, 1);
- else
- ad1843_write_bits(ad1843, &ad1843_DA1F, 1);
- }
- void ad1843_setup_adc(struct snd_ad1843 *ad1843,
- unsigned int framerate,
- snd_pcm_format_t fmt,
- unsigned int channels)
- {
- int da_fmt = 0;
- switch (fmt) {
- case SNDRV_PCM_FORMAT_S8: da_fmt = 0; break;
- case SNDRV_PCM_FORMAT_U8: da_fmt = 0; break;
- case SNDRV_PCM_FORMAT_S16_LE: da_fmt = 1; break;
- case SNDRV_PCM_FORMAT_MU_LAW: da_fmt = 2; break;
- case SNDRV_PCM_FORMAT_A_LAW: da_fmt = 3; break;
- default: break;
- }
- ad1843_write_bits(ad1843, &ad1843_C3C, framerate);
- ad1843_write_multi(ad1843, 2,
- &ad1843_ADLF, da_fmt, &ad1843_ADRF, da_fmt);
- }
- void ad1843_shutdown_adc(struct snd_ad1843 *ad1843)
- {
-
- }
- int ad1843_init(struct snd_ad1843 *ad1843)
- {
- unsigned long later;
- if (ad1843_read_bits(ad1843, &ad1843_INIT) != 0) {
- printk(KERN_ERR "ad1843: AD1843 won't initialize\n");
- return -EIO;
- }
- ad1843_write_bits(ad1843, &ad1843_SCF, 1);
-
- ad1843_write_bits(ad1843, &ad1843_PDNI, 0);
- later = jiffies + msecs_to_jiffies(500);
- while (ad1843_read_bits(ad1843, &ad1843_PDNO)) {
- if (time_after(jiffies, later)) {
- printk(KERN_ERR
- "ad1843: AD1843 won't power up\n");
- return -EIO;
- }
- schedule_timeout_interruptible(5);
- }
-
- ad1843_write_multi(ad1843, 3,
- &ad1843_C1EN, 1,
- &ad1843_C2EN, 1,
- &ad1843_C3EN, 1);
-
-
- ad1843_write_multi(ad1843, 4,
- &ad1843_DA1C, 1,
- &ad1843_DA2C, 2,
- &ad1843_ADLC, 3,
- &ad1843_ADRC, 3);
-
- ad1843_write_bits(ad1843, &ad1843_ADTLK, 1);
- ad1843_write_multi(ad1843, 7,
- &ad1843_ANAEN, 1,
- &ad1843_AAMEN, 1,
- &ad1843_DA1EN, 1,
- &ad1843_DA2EN, 1,
- &ad1843_DDMEN, 1,
- &ad1843_ADLEN, 1,
- &ad1843_ADREN, 1);
-
-
- ad1843_set_gain(ad1843, AD1843_GAIN_RECLEV, 0);
- ad1843_set_gain(ad1843, AD1843_GAIN_LINE, 0);
- ad1843_set_gain(ad1843, AD1843_GAIN_LINE_2, 0);
- ad1843_set_gain(ad1843, AD1843_GAIN_MIC, 0);
- ad1843_set_gain(ad1843, AD1843_GAIN_PCM_0, 0);
- ad1843_set_gain(ad1843, AD1843_GAIN_PCM_1, 0);
-
-
- ad1843_write_multi(ad1843, 2, &ad1843_LDA1GM, 0, &ad1843_RDA1GM, 0);
-
- ad1843_write_multi(ad1843, 2, &ad1843_LDA2GM, 0, &ad1843_RDA2GM, 0);
-
- ad1843_set_recsrc(ad1843, 2);
- ad1843_write_multi(ad1843, 2, &ad1843_LMGE, 1, &ad1843_RMGE, 1);
-
- ad1843_write_multi(ad1843, 3,
- &ad1843_HPOS, 1,
- &ad1843_HPOM, 0,
- &ad1843_MPOM, 0);
- return 0;
- }
|