← Back to branch summary

~ubuntu-branches/ubuntu/precise/linux-lowlatency/precise

« back to all changes in this revision

Viewing changes to drivers/staging/intel_sst/intelmid_v0_control.c

  • Committer: Package Import Robot
  • Author(s): Alessio Igor Bogani
  • Date: 2011-10-26 11:13:05 UTC
  • Revision ID: package-import@ubuntu.com-20111026111305-tz023xykf0i6eosh
Tags: upstream-3.2.0
Import upstream version 3.2.0

Show diffs side-by-side

added added

removed removed

Lines of Context:
drivers/staging/intel_sst/intelmid_v0_control.c
 
1
/*
 
2
 *  intel_sst_v0_control.c - Intel SST Driver for audio engine
 
3
 *
 
4
 *  Copyright (C) 2008-10 Intel Corporation
 
5
 *  Authors:    Vinod Koul <vinod.koul@intel.com>
 
6
 *              Harsha Priya <priya.harsha@intel.com>
 
7
 *              Dharageswari R <dharageswari.r@intel.com>
 
8
 *              KP Jeeja <jeeja.kp@intel.com>
 
9
 *  ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
 
10
 *
 
11
 *  This program is free software; you can redistribute it and/or modify
 
12
 *  it under the terms of the GNU General Public License as published by
 
13
 *  the Free Software Foundation; version 2 of the License.
 
14
 *
 
15
 *  This program is distributed in the hope that it will be useful, but
 
16
 *  WITHOUT ANY WARRANTY; without even the implied warranty of
 
17
 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 
18
 *  General Public License for more details.
 
19
 *
 
20
 *  You should have received a copy of the GNU General Public License along
 
21
 *  with this program; if not, write to the Free Software Foundation, Inc.,
 
22
 *  59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
 
23
 *
 
24
 * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
 
25
 *
 
26
 *  This file contains the control operations of vendor 1
 
27
 */
 
28
 
 
29
#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
 
30
 
 
31
#include <linux/pci.h>
 
32
#include <linux/file.h>
 
33
#include <sound/control.h>
 
34
#include "intel_sst.h"
 
35
#include "intelmid_snd_control.h"
 
36
#include "intelmid.h"
 
37
 
 
38
enum _reg_v1 {
 
39
        VOICEPORT1 = 0x180,
 
40
        VOICEPORT2 = 0x181,
 
41
        AUDIOPORT1 = 0x182,
 
42
        AUDIOPORT2 = 0x183,
 
43
        MISCVOICECTRL = 0x184,
 
44
        MISCAUDCTRL = 0x185,
 
45
        DMICCTRL1 = 0x186,
 
46
        AUDIOBIAS = 0x187,
 
47
        MICCTRL = 0x188,
 
48
        MICLICTRL1 = 0x189,
 
49
        MICLICTRL2 = 0x18A,
 
50
        MICLICTRL3 = 0x18B,
 
51
        VOICEDACCTRL1 = 0x18C,
 
52
        STEREOADCCTRL = 0x18D,
 
53
        AUD15 = 0x18E,
 
54
        AUD16 = 0x18F,
 
55
        AUD17 = 0x190,
 
56
        AUD18 = 0x191,
 
57
        RMIXOUTSEL = 0x192,
 
58
        ANALOGLBR = 0x193,
 
59
        ANALOGLBL = 0x194,
 
60
        POWERCTRL1 = 0x195,
 
61
        POWERCTRL2 = 0x196,
 
62
        HEADSETDETECTINT = 0x197,
 
63
        HEADSETDETECTINTMASK = 0x198,
 
64
        TRIMENABLE = 0x199,
 
65
};
 
66
 
 
67
int rev_id = 0x20;
 
68
static bool jack_det_enabled;
 
69
 
 
70
/****
 
71
 * fs_init_card - initialize the sound card
 
72
 *
 
73
 * This initializes the audio paths to know values in case of this sound card
 
74
 */
 
75
static int fs_init_card(void)
 
76
{
 
77
        struct sc_reg_access sc_access[] = {
 
78
                {0x180, 0x00, 0x0},
 
79
                {0x181, 0x00, 0x0},
 
80
                {0x182, 0xF8, 0x0},
 
81
                {0x183, 0x08, 0x0},
 
82
                {0x184, 0x00, 0x0},
 
83
                {0x185, 0x40, 0x0},
 
84
                {0x186, 0x06, 0x0},
 
85
                {0x187, 0x80, 0x0},
 
86
                {0x188, 0x40, 0x0},
 
87
                {0x189, 0x39, 0x0},
 
88
                {0x18a, 0x39, 0x0},
 
89
                {0x18b, 0x1F, 0x0},
 
90
                {0x18c, 0x00, 0x0},
 
91
                {0x18d, 0x00, 0x0},
 
92
                {0x18e, 0x39, 0x0},
 
93
                {0x18f, 0x39, 0x0},
 
94
                {0x190, 0x39, 0x0},
 
95
                {0x191, 0x11, 0x0},
 
96
                {0x192, 0x0E, 0x0},
 
97
                {0x193, 0x00, 0x0},
 
98
                {0x194, 0x00, 0x0},
 
99
                {0x195, 0x00, 0x0},
 
100
                {0x196, 0x7C, 0x0},
 
101
                {0x197, 0x00, 0x0},
 
102
                {0x198, 0x0B, 0x0},
 
103
                {0x199, 0x00, 0x0},
 
104
                {0x037, 0x3F, 0x0},
 
105
        };
 
106
 
 
107
        snd_pmic_ops_fs.card_status = SND_CARD_INIT_DONE;
 
108
        snd_pmic_ops_fs.master_mute = UNMUTE;
 
109
        snd_pmic_ops_fs.mute_status = UNMUTE;
 
110
        snd_pmic_ops_fs.num_channel = 2;
 
111
        return sst_sc_reg_access(sc_access, PMIC_WRITE, 27);
 
112
}
 
113
 
 
114
static int fs_enable_audiodac(int value)
 
115
{
 
116
        struct sc_reg_access sc_access[3];
 
117
        sc_access[0].reg_addr = AUD16;
 
118
        sc_access[1].reg_addr = AUD17;
 
119
        sc_access[2].reg_addr = AUD15;
 
120
        sc_access[0].mask = sc_access[1].mask = sc_access[2].mask = MASK7;
 
121
 
 
122
        if (snd_pmic_ops_fs.mute_status == MUTE)
 
123
                return 0;
 
124
        if (value == MUTE) {
 
125
                        sc_access[0].value = sc_access[1].value =
 
126
                                sc_access[2].value = 0x80;
 
127
 
 
128
                } else {
 
129
                        sc_access[0].value = sc_access[1].value =
 
130
                        sc_access[2].value =  0x0;
 
131
                }
 
132
        if (snd_pmic_ops_fs.num_channel == 1)
 
133
                sc_access[1].value = sc_access[2].value = 0x80;
 
134
        return sst_sc_reg_access(sc_access, PMIC_READ_MODIFY, 3);
 
135
 
 
136
}
 
137
 
 
138
static int fs_power_up_pb(unsigned int port)
 
139
{
 
140
        struct sc_reg_access sc_access[] = {
 
141
                {AUDIOBIAS, 0x00, MASK7},
 
142
                {POWERCTRL1, 0xC6, 0xC6},
 
143
                {POWERCTRL2, 0x30, 0x30},
 
144
 
 
145
        };
 
146
        int retval = 0;
 
147
 
 
148
        if (snd_pmic_ops_fs.card_status == SND_CARD_UN_INIT)
 
149
                retval = fs_init_card();
 
150
        if (retval)
 
151
                return retval;
 
152
        retval = fs_enable_audiodac(MUTE);
 
153
        retval = sst_sc_reg_access(sc_access, PMIC_READ_MODIFY, 3);
 
154
 
 
155
        if (retval)
 
156
                return retval;
 
157
 
 
158
        pr_debug("in fs power up pb\n");
 
159
        return fs_enable_audiodac(UNMUTE);
 
160
}
 
161
 
 
162
static int fs_power_down_pb(unsigned int device)
 
163
{
 
164
        struct sc_reg_access sc_access[] = {
 
165
                {POWERCTRL1, 0x00, 0xC6},
 
166
                {POWERCTRL2, 0x00, 0x30},
 
167
        };
 
168
        int retval = 0;
 
169
 
 
170
        if (snd_pmic_ops_fs.card_status == SND_CARD_UN_INIT)
 
171
                retval = fs_init_card();
 
172
        if (retval)
 
173
                return retval;
 
174
        retval = fs_enable_audiodac(MUTE);
 
175
        retval = sst_sc_reg_access(sc_access, PMIC_READ_MODIFY, 2);
 
176
 
 
177
        if (retval)
 
178
                return retval;
 
179
 
 
180
        pr_debug("in fsl power down pb\n");
 
181
        return fs_enable_audiodac(UNMUTE);
 
182
}
 
183
 
 
184
static int fs_power_up_cp(unsigned int port)
 
185
{
 
186
        struct sc_reg_access sc_access[] = {
 
187
                {POWERCTRL2, 0x32, 0x32}, /*NOTE power up A ADC only as*/
 
188
                {AUDIOBIAS, 0x00, MASK7},
 
189
                                        /*as turning on V ADC causes noise*/
 
190
        };
 
191
        int retval = 0;
 
192
 
 
193
        if (snd_pmic_ops_fs.card_status == SND_CARD_UN_INIT)
 
194
                retval = fs_init_card();
 
195
        if (retval)
 
196
                return retval;
 
197
        return sst_sc_reg_access(sc_access, PMIC_READ_MODIFY, 2);
 
198
}
 
199
 
 
200
static int fs_power_down_cp(unsigned int device)
 
201
{
 
202
        struct sc_reg_access sc_access[] = {
 
203
                {POWERCTRL2, 0x00, 0x03},
 
204
        };
 
205
        int retval = 0;
 
206
 
 
207
        if (snd_pmic_ops_fs.card_status == SND_CARD_UN_INIT)
 
208
                retval = fs_init_card();
 
209
        if (retval)
 
210
                return retval;
 
211
        return sst_sc_reg_access(sc_access, PMIC_READ_MODIFY, 1);
 
212
}
 
213
 
 
214
static int fs_power_down(void)
 
215
{
 
216
        int retval = 0;
 
217
        struct sc_reg_access sc_access[] = {
 
218
                {AUDIOBIAS, MASK7, MASK7},
 
219
        };
 
220
 
 
221
        if (snd_pmic_ops_fs.card_status == SND_CARD_UN_INIT)
 
222
                retval = fs_init_card();
 
223
        if (retval)
 
224
                return retval;
 
225
        return sst_sc_reg_access(sc_access, PMIC_READ_MODIFY, 1);
 
226
}
 
227
 
 
228
static int fs_set_pcm_voice_params(void)
 
229
{
 
230
        struct sc_reg_access sc_access[] = {
 
231
                {0x180, 0xA0, 0},
 
232
                {0x181, 0x04, 0},
 
233
                {0x182, 0x0, 0},
 
234
                {0x183, 0x0, 0},
 
235
                {0x184, 0x18, 0},
 
236
                {0x185, 0x40, 0},
 
237
                {0x186, 0x06, 0},
 
238
                {0x187, 0x0, 0},
 
239
                {0x188, 0x10, 0},
 
240
                {0x189, 0x39, 0},
 
241
                {0x18a, 0x39, 0},
 
242
                {0x18b, 0x02, 0},
 
243
                {0x18c, 0x0, 0},
 
244
                {0x18d, 0x0, 0},
 
245
                {0x18e, 0x39, 0},
 
246
                {0x18f, 0x0, 0},
 
247
                {0x190, 0x0, 0},
 
248
                {0x191, 0x20, 0},
 
249
                {0x192, 0x20, 0},
 
250
                {0x193, 0x0, 0},
 
251
                {0x194, 0x0, 0},
 
252
                {0x195, 0x06, 0},
 
253
                {0x196, 0x25, 0},
 
254
                {0x197, 0x0, 0},
 
255
                {0x198, 0xF, 0},
 
256
                {0x199, 0x0, 0},
 
257
        };
 
258
        int retval = 0;
 
259
 
 
260
        if (snd_pmic_ops_fs.card_status == SND_CARD_UN_INIT)
 
261
                retval = fs_init_card();
 
262
        if (retval)
 
263
                return retval;
 
264
        return sst_sc_reg_access(sc_access, PMIC_WRITE, 26);
 
265
}
 
266
 
 
267
static int fs_set_audio_port(int status)
 
268
{
 
269
        struct sc_reg_access sc_access[2];
 
270
        int retval = 0;
 
271
 
 
272
        if (snd_pmic_ops_fs.card_status == SND_CARD_UN_INIT)
 
273
                retval = fs_init_card();
 
274
        if (retval)
 
275
                return retval;
 
276
        if (status == DEACTIVATE) {
 
277
                /* Deactivate audio port-tristate and power */
 
278
                sc_access[0].value = 0x00;
 
279
                sc_access[0].mask = MASK6|MASK7;
 
280
                sc_access[0].reg_addr = AUDIOPORT1;
 
281
                sc_access[1].value = 0x00;
 
282
                sc_access[1].mask = MASK4|MASK5;
 
283
                sc_access[1].reg_addr = POWERCTRL2;
 
284
                return sst_sc_reg_access(sc_access, PMIC_READ_MODIFY, 2);
 
285
        } else if (status == ACTIVATE) {
 
286
                /* activate audio port */
 
287
                sc_access[0].value = 0xC0;
 
288
                sc_access[0].mask = MASK6|MASK7;
 
289
                sc_access[0].reg_addr = AUDIOPORT1;
 
290
                sc_access[1].value = 0x30;
 
291
                sc_access[1].mask = MASK4|MASK5;
 
292
                sc_access[1].reg_addr = POWERCTRL2;
 
293
                return sst_sc_reg_access(sc_access, PMIC_READ_MODIFY, 2);
 
294
        } else
 
295
                return -EINVAL;
 
296
}
 
297
 
 
298
static int fs_set_voice_port(int status)
 
299
{
 
300
        struct sc_reg_access sc_access[2];
 
301
        int retval = 0;
 
302
 
 
303
        if (snd_pmic_ops_fs.card_status == SND_CARD_UN_INIT)
 
304
                retval = fs_init_card();
 
305
        if (retval)
 
306
                return retval;
 
307
        if (status == DEACTIVATE) {
 
308
                /* Deactivate audio port-tristate and power */
 
309
                sc_access[0].value = 0x00;
 
310
                sc_access[0].mask = MASK6|MASK7;
 
311
                sc_access[0].reg_addr = VOICEPORT1;
 
312
                sc_access[1].value = 0x00;
 
313
                sc_access[1].mask = MASK0|MASK1;
 
314
                sc_access[1].reg_addr = POWERCTRL2;
 
315
                return sst_sc_reg_access(sc_access, PMIC_READ_MODIFY, 2);
 
316
        } else if (status == ACTIVATE) {
 
317
                /* activate audio port */
 
318
                sc_access[0].value = 0xC0;
 
319
                sc_access[0].mask = MASK6|MASK7;
 
320
                sc_access[0].reg_addr = VOICEPORT1;
 
321
                sc_access[1].value = 0x03;
 
322
                sc_access[1].mask = MASK0|MASK1;
 
323
                sc_access[1].reg_addr = POWERCTRL2;
 
324
                return sst_sc_reg_access(sc_access, PMIC_READ_MODIFY, 2);
 
325
        } else
 
326
                return -EINVAL;
 
327
}
 
328
 
 
329
static int fs_set_pcm_audio_params(int sfreq, int word_size, int num_channel)
 
330
{
 
331
        u8 config1 = 0;
 
332
        struct sc_reg_access sc_access[4];
 
333
        int retval = 0, num_value = 0;
 
334
 
 
335
        if (snd_pmic_ops_fs.card_status == SND_CARD_UN_INIT)
 
336
                retval = fs_init_card();
 
337
        if (retval)
 
338
                return retval;
 
339
        switch (sfreq) {
 
340
        case 8000:
 
341
                config1 = 0x00;
 
342
                break;
 
343
        case 11025:
 
344
                config1 = 0x01;
 
345
                break;
 
346
        case 12000:
 
347
                config1 = 0x02;
 
348
                break;
 
349
        case 16000:
 
350
                config1 = 0x03;
 
351
                break;
 
352
        case 22050:
 
353
                config1 = 0x04;
 
354
                break;
 
355
        case 24000:
 
356
                config1 = 0x05;
 
357
                break;
 
358
        case 26000:
 
359
                config1 = 0x06;
 
360
                break;
 
361
        case 32000:
 
362
                config1 = 0x07;
 
363
                break;
 
364
        case 44100:
 
365
                config1 = 0x08;
 
366
                break;
 
367
        case 48000:
 
368
                config1 = 0x09;
 
369
                break;
 
370
        }
 
371
        snd_pmic_ops_fs.num_channel = num_channel;
 
372
        if (snd_pmic_ops_fs.num_channel == 1)   {
 
373
                sc_access[0].reg_addr = AUD17;
 
374
                sc_access[1].reg_addr = AUD15;
 
375
                sc_access[0].mask = sc_access[1].mask = MASK7;
 
376
                sc_access[0].value = sc_access[1].value = 0x80;
 
377
                sst_sc_reg_access(sc_access, PMIC_READ_MODIFY, 2);
 
378
 
 
379
        } else {
 
380
                sc_access[0].reg_addr = AUD17;
 
381
                sc_access[1].reg_addr = AUD15;
 
382
                sc_access[0].mask = sc_access[1].mask = MASK7;
 
383
                sc_access[0].value = sc_access[1].value = 0x00;
 
384
                sst_sc_reg_access(sc_access, PMIC_READ_MODIFY, 2);
 
385
 
 
386
        }
 
387
        pr_debug("sfreq:%d,Register value = %x\n", sfreq, config1);
 
388
 
 
389
        if (word_size == 24) {
 
390
                sc_access[0].reg_addr  = AUDIOPORT1;
 
391
                sc_access[0].mask = MASK0|MASK1|MASK2|MASK3;
 
392
                sc_access[0].value = 0xFB;
 
393
 
 
394
 
 
395
                sc_access[1].reg_addr  = AUDIOPORT2;
 
396
                sc_access[1].value = config1 | 0x10;
 
397
                sc_access[1].mask = MASK0 | MASK1 | MASK2 | MASK3
 
398
                                        | MASK4 | MASK5 | MASK6;
 
399
 
 
400
                sc_access[2].reg_addr  = MISCAUDCTRL;
 
401
                sc_access[2].value = 0x02;
 
402
                sc_access[2].mask = 0x02;
 
403
 
 
404
                num_value = 3 ;
 
405
 
 
406
        } else {
 
407
 
 
408
                sc_access[0].reg_addr  = AUDIOPORT2;
 
409
                sc_access[0].value = config1;
 
410
                sc_access[0].mask = MASK0|MASK1|MASK2|MASK3;
 
411
 
 
412
                sc_access[1].reg_addr  = MISCAUDCTRL;
 
413
                sc_access[1].value = 0x00;
 
414
                sc_access[1].mask = 0x02;
 
415
                num_value = 2;
 
416
        }
 
417
        return sst_sc_reg_access(sc_access, PMIC_READ_MODIFY, num_value);
 
418
 
 
419
}
 
420
 
 
421
static int fs_set_selected_input_dev(u8 value)
 
422
{
 
423
        struct sc_reg_access sc_access_dmic[] = {
 
424
                {MICCTRL, 0x81, 0xf7},
 
425
                {MICLICTRL3, 0x00, 0xE0},
 
426
        };
 
427
        struct sc_reg_access sc_access_mic[] = {
 
428
                {MICCTRL, 0x40, MASK2|MASK4|MASK5|MASK6|MASK7},
 
429
                {MICLICTRL3, 0x00, 0xE0},
 
430
        };
 
431
        struct sc_reg_access sc_access_hsmic[] = {
 
432
                {MICCTRL, 0x10, MASK2|MASK4|MASK5|MASK6|MASK7},
 
433
                {MICLICTRL3, 0x00, 0xE0},
 
434
        };
 
435
 
 
436
        int retval = 0;
 
437
 
 
438
        if (snd_pmic_ops_fs.card_status == SND_CARD_UN_INIT)
 
439
                retval = fs_init_card();
 
440
        if (retval)
 
441
                return retval;
 
442
 
 
443
        switch (value) {
 
444
        case AMIC:
 
445
                pr_debug("Selecting amic not supported in mono cfg\n");
 
446
                return sst_sc_reg_access(sc_access_mic, PMIC_READ_MODIFY, 2);
 
447
                break;
 
448
 
 
449
        case HS_MIC:
 
450
                pr_debug("Selecting hsmic\n");
 
451
                return sst_sc_reg_access(sc_access_hsmic,
 
452
                                PMIC_READ_MODIFY, 2);
 
453
                break;
 
454
 
 
455
        case DMIC:
 
456
                pr_debug("Selecting dmic\n");
 
457
                return sst_sc_reg_access(sc_access_dmic, PMIC_READ_MODIFY, 2);
 
458
                break;
 
459
 
 
460
        default:
 
461
                return -EINVAL;
 
462
 
 
463
        }
 
464
}
 
465
 
 
466
static int fs_set_selected_output_dev(u8 value)
 
467
{
 
468
        struct sc_reg_access sc_access_hp[] = {
 
469
                {0x191, 0x11, 0x0},
 
470
                {0x192, 0x0E, 0x0},
 
471
        };
 
472
        struct sc_reg_access sc_access_is[] = {
 
473
                {0x191, 0x17, 0xFF},
 
474
                {0x192, 0x08, 0xFF},
 
475
        };
 
476
        int retval = 0;
 
477
 
 
478
        if (snd_pmic_ops_fs.card_status == SND_CARD_UN_INIT)
 
479
                retval = fs_init_card();
 
480
        if (retval)
 
481
                return retval;
 
482
 
 
483
        switch (value) {
 
484
        case STEREO_HEADPHONE:
 
485
                pr_debug("SST DBG:Selecting headphone\n");
 
486
                return sst_sc_reg_access(sc_access_hp, PMIC_WRITE, 2);
 
487
                break;
 
488
        case MONO_EARPIECE:
 
489
        case INTERNAL_SPKR:
 
490
                pr_debug("SST DBG:Selecting internal spkr\n");
 
491
                return sst_sc_reg_access(sc_access_is, PMIC_READ_MODIFY, 2);
 
492
                break;
 
493
 
 
494
        default:
 
495
                return -EINVAL;
 
496
 
 
497
        }
 
498
}
 
499
 
 
500
static int fs_set_mute(int dev_id, u8 value)
 
501
{
 
502
        struct sc_reg_access sc_access[6] = {{0,},};
 
503
        int reg_num = 0;
 
504
        int retval = 0;
 
505
 
 
506
        if (snd_pmic_ops_fs.card_status == SND_CARD_UN_INIT)
 
507
                retval = fs_init_card();
 
508
        if (retval)
 
509
                return retval;
 
510
 
 
511
 
 
512
        pr_debug("dev_id:0x%x value:0x%x\n", dev_id, value);
 
513
        switch (dev_id) {
 
514
        case PMIC_SND_DMIC_MUTE:
 
515
                sc_access[0].reg_addr = MICCTRL;
 
516
                sc_access[1].reg_addr = MICLICTRL1;
 
517
                sc_access[2].reg_addr = MICLICTRL2;
 
518
                sc_access[0].mask = MASK5;
 
519
                sc_access[1].mask = sc_access[2].mask = MASK6;
 
520
                if (value == MUTE) {
 
521
                        sc_access[0].value = 0x20;
 
522
                        sc_access[2].value = sc_access[1].value = 0x40;
 
523
                } else
 
524
                        sc_access[0].value = sc_access[1].value
 
525
                        = sc_access[2].value = 0x0;
 
526
                reg_num = 3;
 
527
                break;
 
528
        case PMIC_SND_HP_MIC_MUTE:
 
529
        case PMIC_SND_AMIC_MUTE:
 
530
                sc_access[0].reg_addr = MICLICTRL1;
 
531
                sc_access[1].reg_addr = MICLICTRL2;
 
532
                sc_access[0].mask = sc_access[1].mask = MASK6;
 
533
                if (value == MUTE)
 
534
                        sc_access[0].value = sc_access[1].value = 0x40;
 
535
                else
 
536
                        sc_access[0].value = sc_access[1].value = 0x0;
 
537
                reg_num = 2;
 
538
                break;
 
539
        case PMIC_SND_LEFT_SPEAKER_MUTE:
 
540
        case PMIC_SND_LEFT_HP_MUTE:
 
541
                sc_access[0].reg_addr = AUD16;
 
542
                sc_access[1].reg_addr = AUD15;
 
543
 
 
544
                sc_access[0].mask = sc_access[1].mask = MASK7;
 
545
                if (value == MUTE)
 
546
                        sc_access[0].value = sc_access[1].value = 0x80;
 
547
                else
 
548
                        sc_access[0].value = sc_access[1].value = 0x0;
 
549
                reg_num = 2;
 
550
                snd_pmic_ops_fs.mute_status = value;
 
551
                break;
 
552
        case PMIC_SND_RIGHT_HP_MUTE:
 
553
        case PMIC_SND_RIGHT_SPEAKER_MUTE:
 
554
                sc_access[0].reg_addr = AUD17;
 
555
                sc_access[1].reg_addr = AUD15;
 
556
                sc_access[0].mask = sc_access[1].mask = MASK7;
 
557
                if (value == MUTE)
 
558
                        sc_access[0].value = sc_access[1].value = 0x80;
 
559
                else
 
560
                        sc_access[0].value = sc_access[1].value = 0x0;
 
561
                snd_pmic_ops_fs.mute_status = value;
 
562
                if (snd_pmic_ops_fs.num_channel == 1)
 
563
                        sc_access[0].value = sc_access[1].value = 0x80;
 
564
                reg_num = 2;
 
565
                break;
 
566
        case PMIC_SND_MUTE_ALL:
 
567
                sc_access[0].reg_addr = AUD16;
 
568
                sc_access[1].reg_addr = AUD17;
 
569
                sc_access[2].reg_addr = AUD15;
 
570
                sc_access[3].reg_addr = MICCTRL;
 
571
                sc_access[4].reg_addr = MICLICTRL1;
 
572
                sc_access[5].reg_addr = MICLICTRL2;
 
573
                sc_access[0].mask = sc_access[1].mask =
 
574
                                sc_access[2].mask = MASK7;
 
575
                sc_access[3].mask = MASK5;
 
576
                sc_access[4].mask = sc_access[5].mask = MASK6;
 
577
 
 
578
                if (value == MUTE) {
 
579
                        sc_access[0].value =
 
580
                        sc_access[1].value = sc_access[2].value = 0x80;
 
581
                        sc_access[3].value = 0x20;
 
582
                        sc_access[4].value = sc_access[5].value = 0x40;
 
583
 
 
584
                } else {
 
585
                        sc_access[0].value = sc_access[1].value =
 
586
                        sc_access[2].value = sc_access[3].value =
 
587
                        sc_access[4].value = sc_access[5].value = 0x0;
 
588
                }
 
589
                if (snd_pmic_ops_fs.num_channel == 1)
 
590
                        sc_access[1].value = sc_access[2].value = 0x80;
 
591
                reg_num = 6;
 
592
                snd_pmic_ops_fs.mute_status = value;
 
593
                snd_pmic_ops_fs.master_mute = value;
 
594
                break;
 
595
 
 
596
        }
 
597
        return sst_sc_reg_access(sc_access, PMIC_READ_MODIFY, reg_num);
 
598
}
 
599
 
 
600
static int fs_set_vol(int dev_id, int value)
 
601
{
 
602
        struct sc_reg_access sc_acces, sc_access[4] = {{0},};
 
603
        int reg_num = 0;
 
604
        int retval = 0;
 
605
 
 
606
        if (snd_pmic_ops_fs.card_status == SND_CARD_UN_INIT)
 
607
                retval = fs_init_card();
 
608
        if (retval)
 
609
                return retval;
 
610
 
 
611
        switch (dev_id) {
 
612
        case PMIC_SND_LEFT_PB_VOL:
 
613
                pr_debug("PMIC_SND_LEFT_PB_VOL:%d\n", value);
 
614
                sc_access[0].value = sc_access[1].value = value;
 
615
                sc_access[0].reg_addr = AUD16;
 
616
                sc_access[1].reg_addr = AUD15;
 
617
                sc_access[0].mask = sc_access[1].mask =
 
618
                        (MASK0|MASK1|MASK2|MASK3|MASK4|MASK5);
 
619
                reg_num = 2;
 
620
                break;
 
621
 
 
622
        case PMIC_SND_RIGHT_PB_VOL:
 
623
                pr_debug("PMIC_SND_RIGHT_PB_VOL:%d\n", value);
 
624
                sc_access[0].value = sc_access[1].value = value;
 
625
                sc_access[0].reg_addr = AUD17;
 
626
                sc_access[1].reg_addr = AUD15;
 
627
                sc_access[0].mask = sc_access[1].mask =
 
628
                        (MASK0|MASK1|MASK2|MASK3|MASK4|MASK5);
 
629
                if (snd_pmic_ops_fs.num_channel == 1) {
 
630
                        sc_access[0].value = sc_access[1].value = 0x80;
 
631
                        sc_access[0].mask = sc_access[1].mask = MASK7;
 
632
                }
 
633
                reg_num = 2;
 
634
                break;
 
635
        case PMIC_SND_CAPTURE_VOL:
 
636
                pr_debug("PMIC_SND_CAPTURE_VOL:%d\n", value);
 
637
                sc_access[0].reg_addr = MICLICTRL1;
 
638
                sc_access[1].reg_addr = MICLICTRL2;
 
639
                sc_access[2].reg_addr = DMICCTRL1;
 
640
                sc_access[2].value = value;
 
641
                sc_access[0].value = sc_access[1].value = value;
 
642
                sc_acces.reg_addr = MICLICTRL3;
 
643
                sc_acces.value = value;
 
644
                sc_acces.mask = (MASK0|MASK1|MASK2|MASK3|MASK5|MASK6|MASK7);
 
645
                retval = sst_sc_reg_access(&sc_acces, PMIC_READ_MODIFY, 1);
 
646
                sc_access[0].mask = sc_access[1].mask =
 
647
                sc_access[2].mask = (MASK0|MASK1|MASK2|MASK3|MASK4|MASK5);
 
648
                reg_num = 3;
 
649
                break;
 
650
 
 
651
        default:
 
652
                return -EINVAL;
 
653
        }
 
654
 
 
655
        return sst_sc_reg_access(sc_access, PMIC_READ_MODIFY, reg_num);
 
656
}
 
657
 
 
658
static int fs_get_mute(int dev_id, u8 *value)
 
659
{
 
660
        struct sc_reg_access sc_access[6] = {{0,},};
 
661
 
 
662
        int retval = 0, temp_value = 0, mask = 0;
 
663
 
 
664
        if (snd_pmic_ops_fs.card_status == SND_CARD_UN_INIT)
 
665
                retval = fs_init_card();
 
666
        if (retval)
 
667
                return retval;
 
668
 
 
669
        switch (dev_id) {
 
670
 
 
671
        case PMIC_SND_AMIC_MUTE:
 
672
        case PMIC_SND_HP_MIC_MUTE:
 
673
                sc_access[0].reg_addr = MICLICTRL1;
 
674
                mask = MASK6;
 
675
                retval = sst_sc_reg_access(sc_access, PMIC_READ, 1);
 
676
                if (sc_access[0].value & mask)
 
677
                        *value = MUTE;
 
678
                else
 
679
                        *value = UNMUTE;
 
680
                break;
 
681
        case PMIC_SND_DMIC_MUTE:
 
682
                sc_access[0].reg_addr = MICCTRL;
 
683
                mask = MASK5;
 
684
                retval = sst_sc_reg_access(sc_access, PMIC_READ, 1);
 
685
                temp_value = (sc_access[0].value & mask);
 
686
                if (temp_value == 0)
 
687
                        *value = UNMUTE;
 
688
                else
 
689
                        *value = MUTE;
 
690
                break;
 
691
 
 
692
        case PMIC_SND_LEFT_HP_MUTE:
 
693
        case PMIC_SND_LEFT_SPEAKER_MUTE:
 
694
                sc_access[0].reg_addr = AUD16;
 
695
                mask = MASK7;
 
696
                retval = sst_sc_reg_access(sc_access, PMIC_READ, 1);
 
697
                temp_value = sc_access[0].value & mask;
 
698
                if (temp_value == 0)
 
699
                        *value = UNMUTE;
 
700
                else
 
701
                        *value = MUTE;
 
702
                break;
 
703
        case PMIC_SND_RIGHT_HP_MUTE:
 
704
        case PMIC_SND_RIGHT_SPEAKER_MUTE:
 
705
                sc_access[0].reg_addr = AUD17;
 
706
                mask = MASK7;
 
707
                retval = sst_sc_reg_access(sc_access, PMIC_READ, 1);
 
708
                temp_value = sc_access[0].value & mask;
 
709
                if (temp_value == 0)
 
710
                        *value = UNMUTE;
 
711
                else
 
712
                        *value = MUTE;
 
713
                break;
 
714
        default:
 
715
                return -EINVAL;
 
716
        }
 
717
 
 
718
        return retval;
 
719
}
 
720
 
 
721
static int fs_get_vol(int dev_id, int *value)
 
722
{
 
723
        struct sc_reg_access sc_access = {0,};
 
724
        int retval = 0, mask = 0;
 
725
 
 
726
        if (snd_pmic_ops_fs.card_status == SND_CARD_UN_INIT)
 
727
                retval = fs_init_card();
 
728
        if (retval)
 
729
                return retval;
 
730
 
 
731
        switch (dev_id) {
 
732
        case PMIC_SND_CAPTURE_VOL:
 
733
                pr_debug("PMIC_SND_CAPTURE_VOL\n");
 
734
                sc_access.reg_addr = MICLICTRL1;
 
735
                mask = (MASK5|MASK4|MASK3|MASK2|MASK1|MASK0);
 
736
                break;
 
737
        case PMIC_SND_LEFT_PB_VOL:
 
738
                pr_debug("PMIC_SND_LEFT_PB_VOL\n");
 
739
                sc_access.reg_addr = AUD16;
 
740
                mask = (MASK5|MASK4|MASK3|MASK2|MASK1|MASK0);
 
741
                break;
 
742
        case PMIC_SND_RIGHT_PB_VOL:
 
743
                pr_debug("PMIC_SND_RT_PB_VOL\n");
 
744
                sc_access.reg_addr = AUD17;
 
745
                mask = (MASK5|MASK4|MASK3|MASK2|MASK1|MASK0);
 
746
                break;
 
747
        default:
 
748
                return -EINVAL;
 
749
        }
 
750
 
 
751
        retval = sst_sc_reg_access(&sc_access, PMIC_READ, 1);
 
752
        pr_debug("value read = 0x%x\n", sc_access.value);
 
753
        *value = (int) (sc_access.value & mask);
 
754
        pr_debug("value returned = 0x%x\n", *value);
 
755
        return retval;
 
756
}
 
757
 
 
758
static void fs_pmic_irq_enable(void *data)
 
759
{
 
760
        struct snd_intelmad *intelmaddata = data;
 
761
        struct sc_reg_access sc_access[] = {
 
762
                                {0x187, 0x00, MASK7},
 
763
                                {0x188, 0x10, MASK4},
 
764
                                {0x18b, 0x10, MASK4},
 
765
        };
 
766
 
 
767
        struct sc_reg_access sc_access_write[] = {
 
768
                                {0x198, 0x00, 0x0},
 
769
        };
 
770
        pr_debug("Audio interrupt enable\n");
 
771
        sst_sc_reg_access(sc_access, PMIC_READ_MODIFY, 3);
 
772
        sst_sc_reg_access(sc_access_write, PMIC_WRITE, 1);
 
773
 
 
774
        intelmaddata->jack[0].jack_status = 0;
 
775
        /*intelmaddata->jack[1].jack_status = 0;*/
 
776
 
 
777
        jack_det_enabled = true;
 
778
        return;
 
779
}
 
780
 
 
781
static void fs_pmic_irq_cb(void *cb_data, u8 value)
 
782
{
 
783
        struct mad_jack *mjack = NULL;
 
784
        struct snd_intelmad *intelmaddata = cb_data;
 
785
        unsigned int present = 0, jack_event_flag = 0, buttonpressflag = 0;
 
786
 
 
787
        mjack = &intelmaddata->jack[0];
 
788
 
 
789
        if (value & 0x4) {
 
790
                if (!jack_det_enabled)
 
791
                        fs_pmic_irq_enable(intelmaddata);
 
792
 
 
793
                /* send headphone detect */
 
794
                pr_debug(":MAD headphone %d\n", value & 0x4);
 
795
                present = !(mjack->jack_status);
 
796
                mjack->jack_status = present;
 
797
                jack_event_flag = 1;
 
798
                mjack->jack.type = SND_JACK_HEADPHONE;
 
799
        }
 
800
 
 
801
        if (value & 0x2) {
 
802
                /* send short push */
 
803
                pr_debug(":MAD short push %d\n", value & 0x2);
 
804
                present = 1;
 
805
                jack_event_flag = 1;
 
806
                buttonpressflag = 1;
 
807
                mjack->jack.type = MID_JACK_HS_SHORT_PRESS;
 
808
        }
 
809
 
 
810
        if (value & 0x1) {
 
811
                /* send long push */
 
812
                pr_debug(":MAD long push %d\n", value & 0x1);
 
813
                present = 1;
 
814
                jack_event_flag = 1;
 
815
                buttonpressflag = 1;
 
816
                mjack->jack.type = MID_JACK_HS_LONG_PRESS;
 
817
        }
 
818
 
 
819
        if (value & 0x8) {
 
820
                if (!jack_det_enabled)
 
821
                        fs_pmic_irq_enable(intelmaddata);
 
822
                /* send headset detect */
 
823
                pr_debug(":MAD headset = %d\n", value & 0x8);
 
824
                present = !(mjack->jack_status);
 
825
                mjack->jack_status = present;
 
826
                jack_event_flag = 1;
 
827
                mjack->jack.type = SND_JACK_HEADSET;
 
828
        }
 
829
 
 
830
 
 
831
        if (jack_event_flag)
 
832
                sst_mad_send_jack_report(&mjack->jack,
 
833
                                                buttonpressflag, present);
 
834
 
 
835
        return;
 
836
}
 
837
static int fs_jack_enable(void)
 
838
{
 
839
        return 0;
 
840
}
 
841
 
 
842
struct snd_pmic_ops snd_pmic_ops_fs = {
 
843
        .set_input_dev = fs_set_selected_input_dev,
 
844
        .set_output_dev = fs_set_selected_output_dev,
 
845
        .set_mute = fs_set_mute,
 
846
        .get_mute = fs_get_mute,
 
847
        .set_vol = fs_set_vol,
 
848
        .get_vol = fs_get_vol,
 
849
        .init_card = fs_init_card,
 
850
        .set_pcm_audio_params = fs_set_pcm_audio_params,
 
851
        .set_pcm_voice_params = fs_set_pcm_voice_params,
 
852
        .set_voice_port = fs_set_voice_port,
 
853
        .set_audio_port = fs_set_audio_port,
 
854
        .power_up_pmic_pb =     fs_power_up_pb,
 
855
        .power_up_pmic_cp =     fs_power_up_cp,
 
856
        .power_down_pmic_pb =   fs_power_down_pb,
 
857
        .power_down_pmic_cp =   fs_power_down_cp,
 
858
        .power_down_pmic        =       fs_power_down,
 
859
        .pmic_irq_cb    =       fs_pmic_irq_cb,
 
860
        /*
 
861
         * Jack detection enabling
 
862
         * need be delayed till first IRQ happen.
 
863
         */
 
864
        .pmic_irq_enable =      NULL,
 
865
        .pmic_jack_enable = fs_jack_enable,
 
866
};