Trim down peak calculation a bit.
[kugel-rb.git] / firmware / drivers / audio / mas35xx.c
blob342d8a3c2ea2aff219b61599b1895a512dc1723d
1 /***************************************************************************
2 * __________ __ ___.
3 * Open \______ \ ____ ____ | | _\_ |__ _______ ___
4 * Source | _// _ \_/ ___\| |/ /| __ \ / _ \ \/ /
5 * Jukebox | | ( <_> ) \___| < | \_\ ( <_> > < <
6 * Firmware |____|_ /\____/ \___ >__|_ \|___ /\____/__/\_ \
7 * \/ \/ \/ \/ \/
8 * $Id$
10 * Driver for MAS35xx audio codec
13 * Copyright (c) 2007 by Christian Gmeiner
15 * This program is free software; you can redistribute it and/or
16 * modify it under the terms of the GNU General Public License
17 * as published by the Free Software Foundation; either version 2
18 * of the License, or (at your option) any later version.
20 * This software is distributed on an "AS IS" basis, WITHOUT WARRANTY OF ANY
21 * KIND, either express or implied.
23 ****************************************************************************/
25 #include "config.h"
26 #include "audiohw.h"
27 #include "mas.h"
29 const struct sound_settings_info audiohw_settings[] = {
30 #if (CONFIG_CODEC == MAS3587F) || (CONFIG_CODEC == MAS3539F)
31 [SOUND_VOLUME] = {"dB", 0, 1,-100, 12, -25},
32 [SOUND_BASS] = {"dB", 0, 1, -12, 12, 6},
33 [SOUND_TREBLE] = {"dB", 0, 1, -12, 12, 6},
34 #elif CONFIG_CODEC == MAS3507D
35 [SOUND_VOLUME] = {"dB", 0, 1, -78, 18, -18},
36 [SOUND_BASS] = {"dB", 0, 1, -15, 15, 7},
37 [SOUND_TREBLE] = {"dB", 0, 1, -15, 15, 7},
38 #endif
39 [SOUND_BALANCE] = {"%", 0, 1,-100, 100, 0},
40 [SOUND_CHANNELS] = {"", 0, 1, 0, 5, 0},
41 [SOUND_STEREO_WIDTH] = {"%", 0, 5, 0, 250, 100},
42 #if (CONFIG_CODEC == MAS3587F) || (CONFIG_CODEC == MAS3539F)
43 [SOUND_LOUDNESS] = {"dB", 0, 1, 0, 17, 0},
44 [SOUND_AVC] = {"", 0, 1, -1, 4, 0},
45 [SOUND_MDB_STRENGTH] = {"dB", 0, 1, 0, 127, 48},
46 [SOUND_MDB_HARMONICS] = {"%", 0, 1, 0, 100, 50},
47 [SOUND_MDB_CENTER] = {"Hz", 0, 10, 20, 300, 60},
48 [SOUND_MDB_SHAPE] = {"Hz", 0, 10, 50, 300, 90},
49 [SOUND_MDB_ENABLE] = {"", 0, 1, 0, 1, 0},
50 [SOUND_SUPERBASS] = {"", 0, 1, 0, 1, 0},
51 #endif
52 #if CONFIG_CODEC == MAS3587F && defined(HAVE_RECORDING)
53 [SOUND_LEFT_GAIN] = {"dB", 1, 1, 0, 15, 8},
54 [SOUND_RIGHT_GAIN] = {"dB", 1, 1, 0, 15, 8},
55 [SOUND_MIC_GAIN] = {"dB", 1, 1, 0, 15, 2},
56 #endif
60 int channel_configuration = SOUND_CHAN_STEREO;
61 int stereo_width = 100;
64 static void set_channel_config(void)
66 /* default values: stereo */
67 unsigned long val_ll = 0x80000;
68 unsigned long val_lr = 0;
69 unsigned long val_rl = 0;
70 unsigned long val_rr = 0x80000;
71 int bank;
73 switch(channel_configuration)
75 /* case SOUND_CHAN_STEREO unnecessary */
77 case SOUND_CHAN_MONO:
78 val_ll = 0xc0000;
79 val_lr = 0xc0000;
80 val_rl = 0xc0000;
81 val_rr = 0xc0000;
82 break;
84 case SOUND_CHAN_CUSTOM:
86 /* fixed point variables (matching MAS internal format)
87 integer part: upper 13 bits (inlcuding sign)
88 fractional part: lower 19 bits */
89 long fp_width, fp_straight, fp_cross;
91 fp_width = (stereo_width << 19) / 100;
92 if (stereo_width <= 100)
94 fp_straight = - ((1<<19) + fp_width) / 2;
95 fp_cross = fp_straight + fp_width;
97 else
99 /* straight = - (1 + width) / (2 * width) */
100 fp_straight = - ((((1<<19) + fp_width) / (fp_width >> 9)) << 9);
101 fp_cross = (1<<19) + fp_straight;
103 val_ll = val_rr = fp_straight & 0xfffff;
104 val_lr = val_rl = fp_cross & 0xfffff;
106 break;
108 case SOUND_CHAN_MONO_LEFT:
109 val_ll = 0x80000;
110 val_lr = 0x80000;
111 val_rl = 0;
112 val_rr = 0;
113 break;
115 case SOUND_CHAN_MONO_RIGHT:
116 val_ll = 0;
117 val_lr = 0;
118 val_rl = 0x80000;
119 val_rr = 0x80000;
120 break;
122 case SOUND_CHAN_KARAOKE:
123 val_ll = 0xc0000;
124 val_lr = 0x40000;
125 val_rl = 0x40000;
126 val_rr = 0xc0000;
127 break;
130 #if (CONFIG_CODEC == MAS3587F) || (CONFIG_CODEC == MAS3539F)
131 bank = MAS_BANK_D0;
132 #elif CONFIG_CODEC == MAS3507D
133 bank = MAS_BANK_D1;
134 #endif
136 mas_writemem(bank, MAS_D0_OUT_LL, &val_ll, 1); /* LL */
137 mas_writemem(bank, MAS_D0_OUT_LR, &val_lr, 1); /* LR */
138 mas_writemem(bank, MAS_D0_OUT_RL, &val_rl, 1); /* RL */
139 mas_writemem(bank, MAS_D0_OUT_RR, &val_rr, 1); /* RR */
142 void audiohw_set_channel(int val)
144 channel_configuration = val;
145 set_channel_config();
148 void audiohw_set_stereo_width(int val)
150 stereo_width = val;
151 if (channel_configuration == SOUND_CHAN_CUSTOM) {
152 set_channel_config();
156 void audiohw_set_bass(int val)
158 #if (CONFIG_CODEC == MAS3587F) || (CONFIG_CODEC == MAS3539F)
159 unsigned tmp = ((unsigned)(val * 8) & 0xff) << 8;
160 mas_codec_writereg(MAS_REG_KBASS, tmp);
161 #elif CONFIG_CODEC == MAS3507D
162 mas_writereg(MAS_REG_KBASS, bass_table[val+15]);
163 #endif
166 #if CONFIG_CODEC == MAS3507D
167 void audiohw_set_prescaler(int val)
169 mas_writereg(MAS_REG_KPRESCALE, prescale_table[val/10]);
171 #endif
173 void audiohw_set_treble(int val)
175 #if (CONFIG_CODEC == MAS3587F) || (CONFIG_CODEC == MAS3539F)
176 unsigned tmp = ((unsigned)(val * 8) & 0xff) << 8;
177 mas_codec_writereg(MAS_REG_KTREBLE, tmp);
178 #elif CONFIG_CODEC == MAS3507D
179 mas_writereg(MAS_REG_KTREBLE, treble_table[val+15]);
180 #endif
183 #if (CONFIG_CODEC == MAS3587F) || (CONFIG_CODEC == MAS3539F)
184 void audiohw_set_volume(int val) {
185 unsigned tmp = ((unsigned)(val + 115) & 0xff) << 8;
186 mas_codec_writereg(MAS_REG_VOLUME_CONTROL, tmp);
189 void audiohw_set_balance(int val) {
190 unsigned tmp = ((unsigned)(val * 127 / 100) & 0xff) << 8;
191 mas_codec_writereg(MAS_REG_BALANCE, tmp);
193 #endif