linux/drivers/staging/intel_sst/intelmid.c

/*
 *   intelmid.c - Intel Sound card driver for MID
 *
 *  Copyright (C) 2008-10 Intel Corp
 *  Authors:	Harsha Priya <priya.harsha@intel.com>
 *		Vinod Koul <vinod.koul@intel.com>
 *		Dharageswari R <dharageswari.r@intel.com>
 *		KP Jeeja <jeeja.kp@intel.com>
 *  ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
 *
 *  This program is free software; you can redistribute it and/or modify
 *  it under the terms of the GNU General Public License as published by
 *  the Free Software Foundation; version 2 of the License.
 *
 *  This program is distributed in the hope that it will be useful, but
 *  WITHOUT ANY WARRANTY; without even the implied warranty of
 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
 *  General Public License for more details.
 *
 *  You should have received a copy of the GNU General Public License along
 *  with this program; if not, write to the Free Software Foundation, Inc.,
 *  59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
 *
 * ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
 * ALSA driver for Intel MID sound card chipset
 */
#include <linux/slab.h>
#include <linux/io.h>
#include <linux/platform_device.h>
#include <linux/interrupt.h>
#include <linux/sched.h>
#include <sound/control.h>
#include <asm/mrst.h>
#include <sound/pcm.h>
#include "jack.h"
#include <sound/pcm_params.h>
#include <sound/initval.h>
#include "intel_sst.h"
#include "intel_sst_ioctl.h"
#include "intelmid_snd_control.h"
#include "intelmid.h"

MODULE_AUTHOR("Vinod Koul <vinod.koul@intel.com>");
MODULE_AUTHOR("Harsha Priya <priya.harsha@intel.com>");
MODULE_AUTHOR("Dharageswari R <dharageswari.r@intel.com>");
MODULE_AUTHOR("KP Jeeja <jeeja.kp@intel.com>");
MODULE_DESCRIPTION("Intel MAD Sound card driver");
MODULE_LICENSE("GPL v2");
MODULE_SUPPORTED_DEVICE("{Intel,Intel_MAD}");


static int card_index = SNDRV_DEFAULT_IDX1;/* Index 0-MAX */
static char *card_id = SNDRV_DEFAULT_STR1;	/* ID for this card */

module_param(card_index, int, 0444);
MODULE_PARM_DESC(card_index, "Index value for INTELMAD soundcard.");
module_param(card_id, charp, 0444);
MODULE_PARM_DESC(card_id, "ID string for INTELMAD soundcard.");

int	sst_card_vendor_id;
int intelmid_audio_interrupt_enable;/*checkpatch fix*/

/* Data path functionalities */
static struct snd_pcm_hardware snd_intelmad_stream = {
	.info =	(SNDRV_PCM_INFO_INTERLEAVED |
			SNDRV_PCM_INFO_DOUBLE |
			SNDRV_PCM_INFO_PAUSE |
			SNDRV_PCM_INFO_RESUME |
			SNDRV_PCM_INFO_MMAP|
			SNDRV_PCM_INFO_MMAP_VALID |
			SNDRV_PCM_INFO_BLOCK_TRANSFER |
			SNDRV_PCM_INFO_SYNC_START),
	.formats = (SNDRV_PCM_FMTBIT_S16 | SNDRV_PCM_FMTBIT_U16 |
			SNDRV_PCM_FMTBIT_S24 | SNDRV_PCM_FMTBIT_U24 |
			SNDRV_PCM_FMTBIT_S32 | SNDRV_PCM_FMTBIT_U32),
	.rates = (SNDRV_PCM_RATE_8000|
			SNDRV_PCM_RATE_44100 |
			SNDRV_PCM_RATE_48000),
	.rate_min = MIN_RATE,

	.rate_max = MAX_RATE,
	.channels_min =	MIN_CHANNEL,
	.channels_max =	MAX_CHANNEL_AMIC,
	.buffer_bytes_max = MAX_BUFFER,
	.period_bytes_min = MIN_PERIOD_BYTES,
	.period_bytes_max = MAX_PERIOD_BYTES,
	.periods_min = MIN_PERIODS,
	.periods_max = MAX_PERIODS,
	.fifo_size = FIFO_SIZE,
};


/**
 * snd_intelmad_pcm_trigger - stream activities are handled here
 *
 * @substream:substream for which the stream function is called
 * @cmd:the stream commamd that requested from upper layer
 *
 * This function is called whenever an a stream activity is invoked
 */
static int snd_intelmad_pcm_trigger(struct snd_pcm_substream *substream,
					int cmd)
{
	int ret_val = 0;
	struct snd_intelmad *intelmaddata;
	struct mad_stream_pvt *stream;
	/*struct stream_buffer buffer_to_sst;*/



	WARN_ON(!substream);

	intelmaddata = snd_pcm_substream_chip(substream);
	stream = substream->runtime->private_data;

	WARN_ON(!intelmaddata->sstdrv_ops);
	WARN_ON(!intelmaddata->sstdrv_ops->scard_ops);

	switch (cmd) {
	case SNDRV_PCM_TRIGGER_START:
		pr_debug("sst: Trigger Start\n");
		ret_val = intelmaddata->sstdrv_ops->control_set(SST_SND_START,
				&stream->stream_info.str_id);
		if (ret_val)
			return ret_val;
		stream->stream_status = RUNNING;
		stream->substream = substream;
		stream->stream_status = RUNNING;
		break;
	case SNDRV_PCM_TRIGGER_STOP:
		pr_debug("sst: in stop\n");
		ret_val = intelmaddata->sstdrv_ops->control_set(SST_SND_DROP,
				&stream->stream_info.str_id);
		if (ret_val)
			return ret_val;
		stream->stream_status = DROPPED;
		break;
	case SNDRV_PCM_TRIGGER_PAUSE_PUSH:
		pr_debug("sst: in pause\n");
		ret_val = intelmaddata->sstdrv_ops->control_set(SST_SND_PAUSE,
				&stream->stream_info.str_id);
		if (ret_val)
			return ret_val;
		stream->stream_status = PAUSED;
		break;
	case SNDRV_PCM_TRIGGER_PAUSE_RELEASE:
		pr_debug("sst: in pause release\n");
		ret_val = intelmaddata->sstdrv_ops->control_set(SST_SND_RESUME,
						&stream->stream_info.str_id);
		if (ret_val)
			return ret_val;
		stream->stream_status = RUNNING;
		break;
	default:
		return -EINVAL;
	}
	return ret_val;
}

/**
* snd_intelmad_pcm_prepare- internal preparation before starting a stream
*
* @substream:  substream for which the function is called
*
* This function is called when a stream is started for internal preparation.
*/
static int snd_intelmad_pcm_prepare(struct snd_pcm_substream *substream)
{
	struct mad_stream_pvt *stream;
	int ret_val = 0;
	struct snd_intelmad *intelmaddata;

	pr_debug("sst: pcm_prepare called\n");

	WARN_ON(!substream);
	stream = substream->runtime->private_data;
	intelmaddata = snd_pcm_substream_chip(substream);
	pr_debug("sst: pb cnt = %d cap cnt = %d\n",\
		intelmaddata->playback_cnt,
		intelmaddata->capture_cnt);

	if (stream->stream_info.str_id) {
		pr_debug("sst: Prepare called for already set stream\n");
		ret_val = intelmaddata->sstdrv_ops->control_set(SST_SND_DROP,
					&stream->stream_info.str_id);
		return ret_val;
	}

	 ret_val = snd_intelmad_alloc_stream(substream);
	if (ret_val < 0)
		return ret_val;
	stream->dbg_cum_bytes = 0;
	if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
			intelmaddata->playback_cnt++;
	else
		intelmaddata->capture_cnt++;
	/* return back the stream id */
	snprintf(substream->pcm->id, sizeof(substream->pcm->id),
			"%d", stream->stream_info.str_id);
	pr_debug("sst: stream id to user = %s\n",
			substream->pcm->id);

	ret_val = snd_intelmad_init_stream(substream);
	if (ret_val)
		return ret_val;
	substream->runtime->hw.info = SNDRV_PCM_INFO_BLOCK_TRANSFER;
	return ret_val;
}

static int snd_intelmad_hw_params(struct snd_pcm_substream *substream,
				    struct snd_pcm_hw_params *hw_params)
{
	int ret_val;

	pr_debug("sst: snd_intelmad_hw_params called\n");
	ret_val = snd_pcm_lib_malloc_pages(substream,
			params_buffer_bytes(hw_params));
	memset(substream->runtime->dma_area, 0,
			params_buffer_bytes(hw_params));

	return ret_val;
}

static int snd_intelmad_hw_free(struct snd_pcm_substream *substream)
{
	pr_debug("sst: snd_intelmad_hw_free called\n");
	return snd_pcm_lib_free_pages(substream);
}

/**
 * snd_intelmad_pcm_pointer- to send the current buffer pointer processed by hw
 *
 * @substream:  substream for which the function is called
 *
 * This function is called by ALSA framework to get the current hw buffer ptr
 * when a period is elapsed
 */
static snd_pcm_uframes_t snd_intelmad_pcm_pointer
			(struct snd_pcm_substream *substream)
{
	/* struct snd_pcm_runtime *runtime = substream->runtime; */
	struct mad_stream_pvt *stream;
	struct snd_intelmad *intelmaddata;
	int ret_val;

	WARN_ON(!substream);

	intelmaddata = snd_pcm_substream_chip(substream);
	stream = substream->runtime->private_data;
	if (stream->stream_status == INIT)
		return 0;

	ret_val = intelmaddata->sstdrv_ops->control_set(SST_SND_BUFFER_POINTER,
				&stream->stream_info);
	if (ret_val) {
		pr_err("sst: error code = 0x%x\n", ret_val);
		return ret_val;
	}
	pr_debug("sst: samples reported out 0x%llx\n",
			stream->stream_info.buffer_ptr);
	pr_debug("sst: Frame bits:: %d period_count :: %d\n",
			(int)substream->runtime->frame_bits,
			(int)substream->runtime->period_size);

	return stream->stream_info.buffer_ptr;

}

/**
 * snd_intelmad_close- to free parameteres when stream is stopped
 *
 * @substream:  substream for which the function is called
 *
 * This function is called by ALSA framework when stream is stopped
 */
static int snd_intelmad_close(struct snd_pcm_substream *substream)
{
	struct snd_intelmad *intelmaddata;
	struct mad_stream_pvt *stream;
	int ret_val = 0;

	WARN_ON(!substream);

	stream = substream->runtime->private_data;

	pr_debug("sst: snd_intelmad_close called\n");
	intelmaddata = snd_pcm_substream_chip(substream);

	pr_debug("sst: str id = %d\n", stream->stream_info.str_id);
	if (stream->stream_info.str_id) {
		/* SST API to actually stop/free the stream */
		ret_val = intelmaddata->sstdrv_ops->control_set(SST_SND_FREE,
				&stream->stream_info.str_id);
		if (substream->stream == SNDRV_PCM_STREAM_PLAYBACK)
			intelmaddata->playback_cnt--;
		else
			intelmaddata->capture_cnt--;
	}
	pr_debug("sst: snd_intelmad_close : pb cnt = %d cap cnt = %d\n",
		intelmaddata->playback_cnt, intelmaddata->capture_cnt);
	kfree(substream->runtime->private_data);
	return ret_val;
}

/**
 * snd_intelmad_open- to set runtime parameters during stream start
 *
 * @substream:  substream for which the function is called
 * @type: audio device type
 *
 * This function is called by ALSA framework when stream is started
 */
static int snd_intelmad_open(struct snd_pcm_substream *substream,
			enum snd_sst_audio_device_type type)
{
	struct snd_intelmad *intelmaddata;
	struct snd_pcm_runtime *runtime;
	struct mad_stream_pvt *stream;

	WARN_ON(!substream);

	pr_debug("sst: snd_intelmad_open called\n");

	intelmaddata = snd_pcm_substream_chip(substream);
	runtime = substream->runtime;
	/* set the runtime hw parameter with local snd_pcm_hardware struct */
	runtime->hw = snd_intelmad_stream;
	if (intelmaddata->cpu_id == CPU_CHIP_PENWELL) {
		runtime->hw = snd_intelmad_stream;
		runtime->hw.rates = SNDRV_PCM_RATE_48000;
		runtime->hw.rate_min = MAX_RATE;
		runtime->hw.formats = (SNDRV_PCM_FMTBIT_S24 |
						SNDRV_PCM_FMTBIT_U24);
		if (intelmaddata->sstdrv_ops->scard_ops->input_dev_id == AMIC)
			runtime->hw.channels_max = MAX_CHANNEL_AMIC;
		else
			runtime->hw.channels_max = MAX_CHANNEL_DMIC;

	}
	/* setup the internal datastruture stream pointers based on it being
	playback or capture stream */
	stream = kzalloc(sizeof(*stream), GFP_KERNEL);
	if (!stream)
		return -ENOMEM;
	stream->stream_info.str_id = 0;
	stream->device = type;
	stream->stream_status = INIT;
	runtime->private_data = stream;
	return snd_pcm_hw_constraint_integer(runtime,
			 SNDRV_PCM_HW_PARAM_PERIODS);
}

static int snd_intelmad_headset_open(struct snd_pcm_substream *substream)
{
	return snd_intelmad_open(substream, SND_SST_DEVICE_HEADSET);
}

static int snd_intelmad_ihf_open(struct snd_pcm_substream *substream)
{
	return snd_intelmad_open(substream, SND_SST_DEVICE_IHF);
}

static int snd_intelmad_vibra_open(struct snd_pcm_substream *substream)
{
	return snd_intelmad_open(substream, SND_SST_DEVICE_VIBRA);
}

static int snd_intelmad_haptic_open(struct snd_pcm_substream *substream)
{
	return snd_intelmad_open(substream, SND_SST_DEVICE_HAPTIC);
}

static struct snd_pcm_ops snd_intelmad_headset_ops = {
	.open = snd_intelmad_headset_open,
	.close = snd_intelmad_close,
	.ioctl = snd_pcm_lib_ioctl,
	.hw_params = snd_intelmad_hw_params,
	.hw_free = snd_intelmad_hw_free,
	.prepare = snd_intelmad_pcm_prepare,
	.trigger = snd_intelmad_pcm_trigger,
	.pointer = snd_intelmad_pcm_pointer,
};

static struct snd_pcm_ops snd_intelmad_ihf_ops = {
	.open = snd_intelmad_ihf_open,
	.close = snd_intelmad_close,
	.ioctl = snd_pcm_lib_ioctl,
	.hw_params = snd_intelmad_hw_params,
	.hw_free = snd_intelmad_hw_free,
	.prepare = snd_intelmad_pcm_prepare,
	.trigger = snd_intelmad_pcm_trigger,
	.pointer = snd_intelmad_pcm_pointer,
};

static struct snd_pcm_ops snd_intelmad_vibra_ops = {
	.open = snd_intelmad_vibra_open,
	.close = snd_intelmad_close,
	.ioctl = snd_pcm_lib_ioctl,
	.hw_params = snd_intelmad_hw_params,
	.hw_free = snd_intelmad_hw_free,
	.prepare = snd_intelmad_pcm_prepare,
	.trigger = snd_intelmad_pcm_trigger,
	.pointer = snd_intelmad_pcm_pointer,
};

static struct snd_pcm_ops snd_intelmad_haptic_ops = {
	.open = snd_intelmad_haptic_open,
	.close = snd_intelmad_close,
	.ioctl = snd_pcm_lib_ioctl,
	.hw_params = snd_intelmad_hw_params,
	.hw_free = snd_intelmad_hw_free,
	.prepare = snd_intelmad_pcm_prepare,
	.trigger = snd_intelmad_pcm_trigger,
	.pointer = snd_intelmad_pcm_pointer,
};

static struct snd_pcm_ops snd_intelmad_capture_ops = {
	.open = snd_intelmad_headset_open,
	.close = snd_intelmad_close,
	.ioctl = snd_pcm_lib_ioctl,
	.hw_params = snd_intelmad_hw_params,
	.hw_free = snd_intelmad_hw_free,
	.prepare = snd_intelmad_pcm_prepare,
	.trigger = snd_intelmad_pcm_trigger,
	.pointer = snd_intelmad_pcm_pointer,
};


/**
 * snd_intelmad_intr_handler- interrupt handler
 *
 * @irq :  irq number of the interrupt received
 * @dev: device context
 *
 * This function is called when an interrupt is raised at the sound card
 */
static irqreturn_t snd_intelmad_intr_handler(int irq, void *dev)
{
	struct snd_intelmad *intelmaddata =
			(struct snd_intelmad *)dev;
	u8 intsts;

	memcpy_fromio(&intsts,
			((void *)(intelmaddata->int_base)),
			sizeof(u8));
	intelmaddata->mad_jack_msg.intsts = intsts;
	intelmaddata->mad_jack_msg.intelmaddata = intelmaddata;

	queue_work(intelmaddata->mad_jack_wq, &intelmaddata->mad_jack_msg.wq);

	return IRQ_HANDLED;
}

void sst_mad_send_jack_report(struct snd_jack *jack,
				int buttonpressevent , int status)
{

	if (!jack) {
		pr_debug("sst: MAD error jack empty\n");

	} else {
		pr_debug("sst: MAD send jack report for = %d!!!\n", status);
		pr_debug("sst: MAD send jack report %d\n", jack->type);
		snd_jack_report(jack, status);

		/*button pressed and released */
		if (buttonpressevent)
			snd_jack_report(jack, 0);
		pr_debug("sst: MAD sending jack report Done !!!\n");
	}



}

void sst_mad_jackdetection_fs(u8 intsts , struct snd_intelmad *intelmaddata)
{
	struct snd_jack *jack = NULL;
	unsigned int present = 0, jack_event_flag = 0, buttonpressflag = 0;
	struct sc_reg_access sc_access[] = {
				{0x187, 0x00, MASK7},
				{0x188, 0x10, MASK4},
				{0x18b, 0x10, MASK4},
	};

	struct sc_reg_access sc_access_write[] = {
				{0x198, 0x00, 0x0},
	};

	if (intsts & 0x4) {

		if (!(intelmid_audio_interrupt_enable)) {
			pr_debug("sst: Audio interrupt enable\n");
			sst_sc_reg_access(sc_access, PMIC_READ_MODIFY, 3);

			sst_sc_reg_access(sc_access_write, PMIC_WRITE, 1);
			intelmid_audio_interrupt_enable = 1;
			intelmaddata->jack[0].jack_status = 0;
			intelmaddata->jack[1].jack_status = 0;

		}
		/* send headphone detect */
		pr_debug("sst: MAD headphone %d\n", intsts & 0x4);
		jack = &intelmaddata->jack[0].jack;
		present = !(intelmaddata->jack[0].jack_status);
		intelmaddata->jack[0].jack_status = present;
		jack_event_flag = 1;

	}

	if (intsts & 0x2) {
		/* send short push */
		pr_debug("sst: MAD short push %d\n", intsts & 0x2);
		jack = &intelmaddata->jack[2].jack;
		present = 1;
		jack_event_flag = 1;
		buttonpressflag = 1;
	}
	if (intsts & 0x1) {
		/* send long push */
		pr_debug("sst: MAD long push %d\n", intsts & 0x1);
		jack = &intelmaddata->jack[3].jack;
		present = 1;
		jack_event_flag = 1;
		buttonpressflag = 1;
	}
	if (intsts & 0x8) {
		if (!(intelmid_audio_interrupt_enable)) {
			pr_debug("sst: Audio interrupt enable\n");
			sst_sc_reg_access(sc_access, PMIC_READ_MODIFY, 3);

			sst_sc_reg_access(sc_access_write, PMIC_WRITE, 1);
			intelmid_audio_interrupt_enable = 1;
			intelmaddata->jack[0].jack_status = 0;
			intelmaddata->jack[1].jack_status = 0;
		}
		/* send headset detect */
		pr_debug("sst: MAD headset = %d\n", intsts & 0x8);
		jack = &intelmaddata->jack[1].jack;
		present = !(intelmaddata->jack[1].jack_status);
		intelmaddata->jack[1].jack_status = present;
		jack_event_flag = 1;
	}

	if (jack_event_flag)
		sst_mad_send_jack_report(jack, buttonpressflag, present);
}


void sst_mad_jackdetection_mx(u8 intsts, struct snd_intelmad *intelmaddata)
{
	u8 value = 0, jack_prev_state = 0;
	struct snd_jack *jack = NULL;
	unsigned int present = 0, jack_event_flag = 0, buttonpressflag = 0;
	time_t  timediff;
	struct sc_reg_access sc_access_read = {0,};
	struct snd_pmic_ops *scard_ops;

	scard_ops = intelmaddata->sstdrv_ops->scard_ops;

	pr_debug("sst: previous value: %x\n", intelmaddata->jack_prev_state);

	if (!(intelmid_audio_interrupt_enable)) {
		pr_debug("sst: Audio interrupt enable\n");
		intelmaddata->jack_prev_state = 0xC0;
		intelmid_audio_interrupt_enable = 1;
	}

	if (intsts & 0x2) {
		jack_prev_state = intelmaddata->jack_prev_state;
		if (intelmaddata->pmic_status == PMIC_INIT) {
			sc_access_read.reg_addr = 0x201;
			sst_sc_reg_access(&sc_access_read, PMIC_READ, 1);
			value = (sc_access_read.value);
			pr_debug("sst: value returned = 0x%x\n", value);
		}

		if (jack_prev_state == 0xc0 && value == 0x40) {
			/*headset detected. */
			pr_debug("sst: MAD headset inserted\n");
			jack = &intelmaddata->jack[1].jack;
			present = 1;
			jack_event_flag = 1;
			intelmaddata->jack[1].jack_status = 1;

		}

		if (jack_prev_state == 0xc0 && value == 0x00) {
			/* headphone  detected. */
			pr_debug("sst: MAD headphone inserted\n");
			jack = &intelmaddata->jack[0].jack;
			present = 1;
			jack_event_flag = 1;

		}

		if (jack_prev_state == 0x40 && value == 0xc0) {
			/*headset  removed*/
			pr_debug("sst: Jack headset status %d\n",
				intelmaddata->jack[1].jack_status);
			pr_debug("sst: MAD headset removed\n");
			jack = &intelmaddata->jack[1].jack;
			present = 0;
			jack_event_flag = 1;
			intelmaddata->jack[1].jack_status = 0;
		}

		if (jack_prev_state == 0x00 && value == 0xc0) {
			/* headphone  detected. */
			pr_debug("sst: Jack headphone status %d\n",
					intelmaddata->jack[0].jack_status);
			pr_debug("sst: headphone removed\n");
			jack = &intelmaddata->jack[0].jack;
			present = 0;
			jack_event_flag = 1;
		}

		if (jack_prev_state == 0x40 && value == 0x00) {
			/*button pressed*/
			do_gettimeofday(&intelmaddata->jack[1].buttonpressed);
			pr_debug("sst: MAD button press detected n");
		}


		if (jack_prev_state == 0x00 && value == 0x40) {
			if (intelmaddata->jack[1].jack_status) {
				/*button pressed*/
				do_gettimeofday(
					&intelmaddata->jack[1].buttonreleased);
				/*button pressed */
				pr_debug("sst: Button Released detected\n");
				timediff = intelmaddata->jack[1].
					buttonreleased.tv_sec - intelmaddata->
					jack[1].buttonpressed.tv_sec;
				buttonpressflag = 1;
				if (timediff > 1) {
					pr_debug("sst: long press detected\n");
					/* send headphone detect/undetect */
					jack = &intelmaddata->jack[3].jack;
					present = 1;
					jack_event_flag = 1;
				} else {
					pr_debug("sst: short press detected\n");
					/* send headphone detect/undetect */
					jack = &intelmaddata->jack[2].jack;
					present = 1;
					jack_event_flag = 1;
				}
			}

		}
		intelmaddata->jack_prev_state = value;
	}
	if (jack_event_flag)
		sst_mad_send_jack_report(jack, buttonpressflag, present);
}


void sst_mad_jackdetection_nec(u8 intsts, struct snd_intelmad *intelmaddata)
{
	u8 value = 0;
	struct snd_jack *jack = NULL;
	unsigned int present = 0, jack_event_flag = 0, buttonpressflag = 0;
	struct sc_reg_access sc_access_read = {0,};

	if (intelmaddata->pmic_status == PMIC_INIT) {
		sc_access_read.reg_addr = 0x132;
		sst_sc_reg_access(&sc_access_read, PMIC_READ, 1);
		value = (sc_access_read.value);
		pr_debug("sst: value returned = 0x%x\n", value);
	}
	if (intsts & 0x1) {
		pr_debug("sst: headset detected\n");
		/* send headset detect/undetect */
		jack = &intelmaddata->jack[1].jack;
		present = (value == 0x1) ? 1 : 0;
		jack_event_flag = 1;
	}
	if (intsts & 0x2) {
		pr_debug("sst: headphone detected\n");
		/* send headphone detect/undetect */
		jack = &intelmaddata->jack[0].jack;
		present = (value == 0x2) ? 1 : 0;
		jack_event_flag = 1;
	}
	if (intsts & 0x4) {
		pr_debug("sst: short push detected\n");
		/* send short push */
		jack = &intelmaddata->jack[2].jack;
		present = 1;
		jack_event_flag = 1;
		buttonpressflag = 1;
	}
	if (intsts & 0x8) {
		pr_debug("sst: long push detected\n");
		/* send long push */
		jack = &intelmaddata->jack[3].jack;
		present = 1;
		jack_event_flag = 1;
		buttonpressflag = 1;
	}

	if (jack_event_flag)
		sst_mad_send_jack_report(jack, buttonpressflag, present);


}

void sst_process_mad_jack_detection(struct work_struct *work)
{
	u8 intsts;
	struct mad_jack_msg_wq *mad_jack_detect =
			container_of(work, struct mad_jack_msg_wq, wq);

	struct snd_intelmad *intelmaddata =
			mad_jack_detect->intelmaddata;

	intsts = mad_jack_detect->intsts;

	switch (intelmaddata->sstdrv_ops->vendor_id) {
	case SND_FS:
		sst_mad_jackdetection_fs(intsts , intelmaddata);
		break;
	case SND_MX:
		sst_mad_jackdetection_mx(intsts , intelmaddata);
		break;
	case SND_NC:
		sst_mad_jackdetection_nec(intsts , intelmaddata);
		break;
	}
}


static int __devinit snd_intelmad_register_irq(
					struct snd_intelmad *intelmaddata)
{
	int ret_val;
	u32 regbase = AUDINT_BASE, regsize = 8;
	char *drv_name;

	pr_debug("sst: irq reg done, regbase 0x%x, regsize 0x%x\n",
					regbase, regsize);
	intelmaddata->int_base = ioremap_nocache(regbase, regsize);
	if (!intelmaddata->int_base)
		pr_err("sst: Mapping of cache failed\n");
	pr_debug("sst: irq = 0x%x\n", intelmaddata->irq);
	if (intelmaddata->cpu_id == CPU_CHIP_PENWELL)
		drv_name = DRIVER_NAME_MFLD;
	else
		drv_name = DRIVER_NAME_MRST;
	ret_val = request_irq(intelmaddata->irq,
				snd_intelmad_intr_handler,
				IRQF_SHARED, drv_name,
				intelmaddata);
	if (ret_val)
		pr_err("sst: cannot register IRQ\n");
	return ret_val;
}

static int __devinit snd_intelmad_sst_register(
			struct snd_intelmad *intelmaddata)
{
	int ret_val = 0;
	struct snd_pmic_ops *intelmad_vendor_ops[MAX_VENDORS] = {
		&snd_pmic_ops_fs,
		&snd_pmic_ops_mx,
		&snd_pmic_ops_nc,
		&snd_msic_ops
	};

	struct sc_reg_access vendor_addr = {0x00, 0x00, 0x00};

	if (intelmaddata->cpu_id == CPU_CHIP_LINCROFT) {
		ret_val = sst_sc_reg_access(&vendor_addr, PMIC_READ, 1);
		if (ret_val)
			return ret_val;
		sst_card_vendor_id = (vendor_addr.value & (MASK2|MASK1|MASK0));
		pr_debug("sst: orginal n extrated vendor id = 0x%x %d\n",
				vendor_addr.value, sst_card_vendor_id);
		if (sst_card_vendor_id < 0 || sst_card_vendor_id > 2) {
			pr_err("sst: vendor card not supported!!\n");
			return -EIO;
		}
	} else
		sst_card_vendor_id = 0x3;

	intelmaddata->sstdrv_ops->module_name = SST_CARD_NAMES;
	intelmaddata->sstdrv_ops->vendor_id = sst_card_vendor_id;
	BUG_ON(!intelmad_vendor_ops[sst_card_vendor_id]);
	intelmaddata->sstdrv_ops->scard_ops =
			intelmad_vendor_ops[sst_card_vendor_id];

	if (intelmaddata->cpu_id == CPU_CHIP_PENWELL) {
		intelmaddata->sstdrv_ops->scard_ops->pb_on = 0;
		intelmaddata->sstdrv_ops->scard_ops->cap_on = 0;
		intelmaddata->sstdrv_ops->scard_ops->input_dev_id = DMIC;
		intelmaddata->sstdrv_ops->scard_ops->output_dev_id =
							STEREO_HEADPHONE;
	}

	/* registering with SST driver to get access to SST APIs to use */
	ret_val = register_sst_card(intelmaddata->sstdrv_ops);
	if (ret_val) {
		pr_err("sst: sst card registration failed\n");
		return ret_val;
	}

	sst_card_vendor_id = intelmaddata->sstdrv_ops->vendor_id;
	intelmaddata->pmic_status = PMIC_UNINIT;
	return ret_val;
}

/* Driver Init/exit functionalities */
/**
 * snd_intelmad_pcm_new - to setup pcm for the card
 *
 * @card:  pointer to the sound card structure
 * @intelmaddata: pointer to internal context
 * @pb: playback count for this card
 * @cap: capture count for this card
 * @index: device index
 *
 * This function is called from probe function to set up pcm params
 * and functions
 */
static int __devinit snd_intelmad_pcm_new(struct snd_card *card,
			struct snd_intelmad *intelmaddata,
			unsigned int pb, unsigned int cap, unsigned int index)
{
	int ret_val = 0;
	struct snd_pcm *pcm;
	char name[32] = INTEL_MAD;
	struct snd_pcm_ops *pb_ops = NULL, *cap_ops = NULL;

	pr_debug("sst: called for pb %d, cp %d, idx %d\n", pb, cap, index);
	ret_val = snd_pcm_new(card, name, index, pb, cap, &pcm);
	if (ret_val)
		return ret_val;
	/* setup the ops for playback and capture streams */
	switch (index) {
	case 0:
		pb_ops = &snd_intelmad_headset_ops;
		cap_ops = &snd_intelmad_capture_ops;
		break;
	case 1:
		pb_ops = &snd_intelmad_ihf_ops;
		cap_ops = &snd_intelmad_capture_ops;
		break;
	case 2:
		pb_ops = &snd_intelmad_vibra_ops;
		cap_ops = &snd_intelmad_capture_ops;
		break;
	case 3:
		pb_ops = &snd_intelmad_haptic_ops;
		cap_ops = &snd_intelmad_capture_ops;
		break;
	}
	if (pb)
		snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_PLAYBACK, pb_ops);
	if (cap)
		snd_pcm_set_ops(pcm, SNDRV_PCM_STREAM_CAPTURE, cap_ops);
	/* setup private data which can be retrieved when required */
	pcm->private_data = intelmaddata;
	pcm->info_flags = 0;
	strncpy(pcm->name, card->shortname, strlen(card->shortname));
	/* allocate dma pages for ALSA stream operations */
	snd_pcm_lib_preallocate_pages_for_all(pcm,
			SNDRV_DMA_TYPE_CONTINUOUS,
			snd_dma_continuous_data(GFP_KERNEL),
			MIN_BUFFER, MAX_BUFFER);
	return ret_val;
}

static int __devinit snd_intelmad_pcm(struct snd_card *card,
				struct snd_intelmad *intelmaddata)
{
	int ret_val = 0;

	WARN_ON(!card);
	WARN_ON(!intelmaddata);
	pr_debug("sst: snd_intelmad_pcm called\n");
	ret_val = snd_intelmad_pcm_new(card, intelmaddata, 1, 1, 0);
	if (intelmaddata->cpu_id == CPU_CHIP_LINCROFT)
		return ret_val;
	ret_val = snd_intelmad_pcm_new(card, intelmaddata, 1, 0, 1);
	if (ret_val)
		return ret_val;
	ret_val = snd_intelmad_pcm_new(card, intelmaddata, 1, 0, 2);
	if (ret_val)
		return ret_val;
	return snd_intelmad_pcm_new(card, intelmaddata, 1, 0, 3);
}

/**
 * snd_intelmad_jack- to setup jack settings of the card
 *
 * @intelmaddata: pointer to internal context
 *
 * This function is called send jack events
 */
static int snd_intelmad_jack(struct snd_intelmad *intelmaddata)
{
	struct snd_jack *jack;
	int retval;

	pr_debug("sst: snd_intelmad_jack called\n");
	jack = &intelmaddata->jack[0].jack;
	retval = snd_jack_new(intelmaddata->card, "Headphone",
				SND_JACK_HEADPHONE, &jack);
	if (retval < 0)
		return retval;
	snd_jack_report(jack, 0);

	jack->private_data = jack;
	intelmaddata->jack[0].jack = *jack;


	jack = &intelmaddata->jack[1].jack;
	retval = snd_jack_new(intelmaddata->card, "Headset",
				SND_JACK_HEADSET, &jack);
	if (retval < 0)
		return retval;



	jack->private_data = jack;
	intelmaddata->jack[1].jack = *jack;


	jack = &intelmaddata->jack[2].jack;
	retval = snd_jack_new(intelmaddata->card, "Short Press",
				SND_JACK_HS_SHORT_PRESS, &jack);
	if (retval < 0)
		return retval;


	jack->private_data = jack;
	intelmaddata->jack[2].jack = *jack;


	jack = &intelmaddata->jack[3].jack;
	retval = snd_jack_new(intelmaddata->card, "Long Press",
				SND_JACK_HS_LONG_PRESS, &jack);
	if (retval < 0)
		return retval;


	jack->private_data = jack;
	intelmaddata->jack[3].jack = *jack;

	return retval;
}

/**
 * snd_intelmad_mixer- to setup mixer settings of the card
 *
 * @intelmaddata: pointer to internal context
 *
 * This function is called from probe function to set up mixer controls
 */
static int __devinit snd_intelmad_mixer(struct snd_intelmad *intelmaddata)
{
	struct snd_card *card;
	unsigned int idx;
	int ret_val = 0, max_controls = 0;
	char *mixername = "IntelMAD Controls";
	struct snd_kcontrol_new *controls;

	WARN_ON(!intelmaddata);

	card = intelmaddata->card;
	strncpy(card->mixername, mixername, sizeof(card->mixername)-1);
	/* add all widget controls and expose the same */
	if (intelmaddata->cpu_id == CPU_CHIP_PENWELL) {
		max_controls = MAX_CTRL_MFLD;
		controls = snd_intelmad_controls_mfld;
	} else {
		max_controls = MAX_CTRL_MRST;
		controls = snd_intelmad_controls_mrst;
	}
	for (idx = 0; idx < max_controls; idx++) {
		ret_val = snd_ctl_add(card,
				snd_ctl_new1(&controls[idx],
				intelmaddata));
		pr_debug("sst: mixer[idx]=%d added\n", idx);
		if (ret_val) {
			pr_err("sst: in adding of control index = %d\n", idx);
			break;
		}
	}
	return ret_val;
}

static int snd_intelmad_dev_free(struct snd_device *device)
{
	struct snd_intelmad *intelmaddata;

	WARN_ON(!device);

	intelmaddata = device->device_data;

	pr_debug("sst: snd_intelmad_dev_free called\n");
	snd_card_free(intelmaddata->card);
	/*genl_unregister_family(&audio_event_genl_family);*/
	unregister_sst_card(intelmaddata->sstdrv_ops);

	/* free allocated memory for internal context */
	destroy_workqueue(intelmaddata->mad_jack_wq);
	kfree(intelmaddata->sstdrv_ops);
	kfree(intelmaddata);
	return 0;
}

static int __devinit snd_intelmad_create(
		struct snd_intelmad *intelmaddata,
		struct snd_card *card)
{
	int ret_val;
	static struct snd_device_ops ops = {
		.dev_free =	snd_intelmad_dev_free,
	};

	WARN_ON(!intelmaddata);
	WARN_ON(!card);
	/* ALSA api to register for the device */
	ret_val = snd_device_new(card, SNDRV_DEV_LOWLEVEL, intelmaddata, &ops);
	return ret_val;
}

/**
* snd_intelmad_probe- function registred for init
* @pdev :  pointer to the device struture
* This function is called when the device is initialized
*/
int __devinit snd_intelmad_probe(struct platform_device *pdev)
{
	struct snd_card *card;
	int ret_val;
	struct snd_intelmad *intelmaddata;
	const struct platform_device_id *id = platform_get_device_id(pdev);
	unsigned int cpu_id = (unsigned int)id->driver_data;

	pr_debug("sst: probe for %s cpu_id %d\n", pdev->name, cpu_id);
	if (!strcmp(pdev->name, DRIVER_NAME_MRST))
		pr_debug("sst: detected MRST\n");
	else if (!strcmp(pdev->name, DRIVER_NAME_MFLD))
		pr_debug("sst: detected MFLD\n");
	else {
		pr_err("sst: detected unknown device abort!!\n");
		return -EIO;
	}
	if ((cpu_id < CPU_CHIP_LINCROFT) || (cpu_id > CPU_CHIP_PENWELL)) {
		pr_err("sst: detected unknown cpu_id abort!!\n");
		return -EIO;
	}
	/* allocate memory for saving internal context and working */
	intelmaddata = kzalloc(sizeof(*intelmaddata), GFP_KERNEL);
	if (!intelmaddata) {
		pr_debug("sst: mem alloctn fail\n");
		return -ENOMEM;
	}

	/* allocate memory for LPE API set */
	intelmaddata->sstdrv_ops = kzalloc(sizeof(struct intel_sst_card_ops),
					GFP_KERNEL);
	if (!intelmaddata->sstdrv_ops) {
		pr_err("sst: mem allocation for ops fail\n");
		kfree(intelmaddata);
		return -ENOMEM;
	}

	intelmaddata->cpu_id = cpu_id;
	/* create a card instance with ALSA framework */
	ret_val = snd_card_create(card_index, card_id, THIS_MODULE, 0, &card);
	if (ret_val) {
		pr_err("sst: snd_card_create fail\n");
		goto free_allocs;
	}

	intelmaddata->pdev = pdev;
	intelmaddata->irq = platform_get_irq(pdev, 0);
	platform_set_drvdata(pdev, intelmaddata);
	intelmaddata->card = card;
	intelmaddata->card_id = card_id;
	intelmaddata->card_index = card_index;
	intelmaddata->master_mute = UNMUTE;
	intelmaddata->playback_cnt =  intelmaddata->capture_cnt = 0;
	strncpy(card->driver, INTEL_MAD, strlen(INTEL_MAD));
	strncpy(card->shortname, INTEL_MAD, strlen(INTEL_MAD));

	intelmaddata->sstdrv_ops->module_name = SST_CARD_NAMES;
	/* registering with LPE driver to get access to SST APIs to use */
	ret_val = snd_intelmad_sst_register(intelmaddata);
	if (ret_val) {
		pr_err("sst: snd_intelmad_sst_register failed\n");
		goto free_allocs;
	}

	intelmaddata->pmic_status = PMIC_INIT;

	ret_val = snd_intelmad_pcm(card, intelmaddata);
	if (ret_val) {
		pr_err("sst: snd_intelmad_pcm failed\n");
		goto free_allocs;
	}

	ret_val = snd_intelmad_mixer(intelmaddata);
	if (ret_val) {
		pr_err("sst: snd_intelmad_mixer failed\n");
		goto free_allocs;
	}

	ret_val = snd_intelmad_jack(intelmaddata);
	if (ret_val) {
		pr_err("sst: snd_intelmad_jack failed\n");
		goto free_allocs;
	}

	/*create work queue for jack interrupt*/
	INIT_WORK(&intelmaddata->mad_jack_msg.wq,
		sst_process_mad_jack_detection);

	intelmaddata->mad_jack_wq = create_workqueue("sst_mad_jack_wq");
	if (!intelmaddata->mad_jack_wq)
		goto free_mad_jack_wq;

	ret_val = snd_intelmad_register_irq(intelmaddata);
	if (ret_val) {
		pr_err("sst: snd_intelmad_register_irq fail\n");
		goto free_allocs;
	}

	/* internal function call to register device with ALSA */
	ret_val = snd_intelmad_create(intelmaddata, card);
	if (ret_val) {
		pr_err("sst: snd_intelmad_create failed\n");
		goto free_allocs;
	}
	card->private_data = &intelmaddata;
	snd_card_set_dev(card, &pdev->dev);
	ret_val = snd_card_register(card);
	if (ret_val) {
		pr_err("sst: snd_card_register failed\n");
		goto free_allocs;
	}

	pr_debug("sst:snd_intelmad_probe complete\n");
	return ret_val;

free_mad_jack_wq:
	destroy_workqueue(intelmaddata->mad_jack_wq);
free_allocs:
	pr_err("sst: probe failed\n");
	snd_card_free(card);
	kfree(intelmaddata->sstdrv_ops);
	kfree(intelmaddata);
	return ret_val;
}


static int snd_intelmad_remove(struct platform_device *pdev)
{
	struct snd_intelmad *intelmaddata = platform_get_drvdata(pdev);

	if (intelmaddata) {
		snd_card_free(intelmaddata->card);
		unregister_sst_card(intelmaddata->sstdrv_ops);
		/* free allocated memory for internal context */
		destroy_workqueue(intelmaddata->mad_jack_wq);
		kfree(intelmaddata->sstdrv_ops);
		kfree(intelmaddata);
	}
	return 0;
}

/*********************************************************************
 *		Driver initialization and exit
 *********************************************************************/
static const struct platform_device_id snd_intelmad_ids[] = {
	{DRIVER_NAME_MRST, CPU_CHIP_LINCROFT},
	{DRIVER_NAME_MFLD, CPU_CHIP_PENWELL},
	{"", 0},

};

static struct platform_driver snd_intelmad_driver = {
	.driver = {
		.owner = THIS_MODULE,
		.name = "intel_mid_sound_card",
	},
	.id_table = snd_intelmad_ids,
	.probe = snd_intelmad_probe,
	.remove = __devexit_p(snd_intelmad_remove),
};

/*
 * alsa_card_intelmad_init- driver init function
 *
 * This function is called when driver module is inserted
 */
static int __init alsa_card_intelmad_init(void)
{
	pr_debug("sst: mad_init called\n");
	return platform_driver_register(&snd_intelmad_driver);
}

/**
 * alsa_card_intelmad_exit- driver exit function
 *
 * This function is called when driver module is removed
 */
static void __exit alsa_card_intelmad_exit(void)
{
	pr_debug("sst:mad_exit called\n");
	return platform_driver_unregister(&snd_intelmad_driver);
}

module_init(alsa_card_intelmad_init)
module_exit(alsa_card_intelmad_exit)