[GitHub/mt8127/android_kernel_alcatel_ttab.git] / sound / core / hrtimer.c

/*
 * ALSA timer back-end using hrtimer
 * Copyright (C) 2008 Takashi Iwai
 *
 *   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; either version 2 of the License, or
 *   (at your option) any later version.
 *
 *   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
 *
 */

#include <linux/init.h>
#include <linux/slab.h>
#include <linux/module.h>
#include <linux/moduleparam.h>
#include <linux/hrtimer.h>
#include <sound/core.h>
#include <sound/timer.h>

MODULE_AUTHOR("Takashi Iwai <tiwai@suse.de>");
MODULE_DESCRIPTION("ALSA hrtimer backend");
MODULE_LICENSE("GPL");

MODULE_ALIAS("snd-timer-" __stringify(SNDRV_TIMER_GLOBAL_HRTIMER));

#define NANO_SEC	1000000000UL	/* 10^9 in sec */
static unsigned int resolution;

struct snd_hrtimer {
	struct snd_timer *timer;
	struct hrtimer hrt;
	atomic_t running;
};

static enum hrtimer_restart snd_hrtimer_callback(struct hrtimer *hrt)
{
	struct snd_hrtimer *stime = container_of(hrt, struct snd_hrtimer, hrt);
	struct snd_timer *t = stime->timer;
	unsigned long oruns;

	if (!atomic_read(&stime->running))
		return HRTIMER_NORESTART;

	oruns = hrtimer_forward_now(hrt, ns_to_ktime(t->sticks * resolution));
	snd_timer_interrupt(stime->timer, t->sticks * oruns);

	if (!atomic_read(&stime->running))
		return HRTIMER_NORESTART;
	return HRTIMER_RESTART;
}

static int snd_hrtimer_open(struct snd_timer *t)
{
	struct snd_hrtimer *stime;

	stime = kmalloc(sizeof(*stime), GFP_KERNEL);
	if (!stime)
		return -ENOMEM;
	hrtimer_init(&stime->hrt, CLOCK_MONOTONIC, HRTIMER_MODE_REL);
	stime->timer = t;
	stime->hrt.function = snd_hrtimer_callback;
	atomic_set(&stime->running, 0);
	t->private_data = stime;
	return 0;
}

static int snd_hrtimer_close(struct snd_timer *t)
{
	struct snd_hrtimer *stime = t->private_data;

	if (stime) {
		hrtimer_cancel(&stime->hrt);
		kfree(stime);
		t->private_data = NULL;
	}
	return 0;
}

static int snd_hrtimer_start(struct snd_timer *t)
{
	struct snd_hrtimer *stime = t->private_data;

	atomic_set(&stime->running, 0);
	hrtimer_try_to_cancel(&stime->hrt);
	hrtimer_start(&stime->hrt, ns_to_ktime(t->sticks * resolution),
		      HRTIMER_MODE_REL);
	atomic_set(&stime->running, 1);
	return 0;
}

static int snd_hrtimer_stop(struct snd_timer *t)
{
	struct snd_hrtimer *stime = t->private_data;
	atomic_set(&stime->running, 0);
	hrtimer_try_to_cancel(&stime->hrt);
	return 0;
}

static struct snd_timer_hardware hrtimer_hw = {
	.flags =	SNDRV_TIMER_HW_AUTO | SNDRV_TIMER_HW_TASKLET,
	.open =		snd_hrtimer_open,
	.close =	snd_hrtimer_close,
	.start =	snd_hrtimer_start,
	.stop =		snd_hrtimer_stop,
};

/*
 * entry functions
 */

static struct snd_timer *mytimer;

static int __init snd_hrtimer_init(void)
{
	struct snd_timer *timer;
	struct timespec tp;
	int err;

	hrtimer_get_res(CLOCK_MONOTONIC, &tp);
	if (tp.tv_sec > 0 || !tp.tv_nsec) {
		snd_printk(KERN_ERR
			   "snd-hrtimer: Invalid resolution %u.%09u",
			   (unsigned)tp.tv_sec, (unsigned)tp.tv_nsec);
		return -EINVAL;
	}
	resolution = tp.tv_nsec;

	/* Create a new timer and set up the fields */
	err = snd_timer_global_new("hrtimer", SNDRV_TIMER_GLOBAL_HRTIMER,
				   &timer);
	if (err < 0)
		return err;

	timer->module = THIS_MODULE;
	strcpy(timer->name, "HR timer");
	timer->hw = hrtimer_hw;
	timer->hw.resolution = resolution;
	timer->hw.ticks = NANO_SEC / resolution;

	err = snd_timer_global_register(timer);
	if (err < 0) {
		snd_timer_global_free(timer);
		return err;
	}
	mytimer = timer; /* remember this */

	return 0;
}

static void __exit snd_hrtimer_exit(void)
{
	if (mytimer) {
		snd_timer_global_free(mytimer);
		mytimer = NULL;
	}
}

module_init(snd_hrtimer_init);
module_exit(snd_hrtimer_exit);
Commit	Line	Data
bbaf5e97	1	/*
647808a6 TI	2	* ALSA timer back-end using hrtimer
	3	* Copyright (C) 2008 Takashi Iwai
	4	*
	5	* This program is free software; you can redistribute it and/or modify
	6	* it under the terms of the GNU General Public License as published by
	7	* the Free Software Foundation; either version 2 of the License, or
	8	* (at your option) any later version.
	9	*
	10	* This program is distributed in the hope that it will be useful,
	11	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	12	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	13	* GNU General Public License for more details.
	14	*
	15	* You should have received a copy of the GNU General Public License
	16	* along with this program; if not, write to the Free Software
	17	* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
	18	*
bbaf5e97 TI	19	*/
	20
	21	#include <linux/init.h>
5a0e3ad6	22	#include <linux/slab.h>
bbaf5e97 TI	23	#include <linux/module.h>
	24	#include <linux/moduleparam.h>
	25	#include <linux/hrtimer.h>
	26	#include <sound/core.h>
	27	#include <sound/timer.h>
	28
	29	MODULE_AUTHOR("Takashi Iwai <tiwai@suse.de>");
	30	MODULE_DESCRIPTION("ALSA hrtimer backend");
	31	MODULE_LICENSE("GPL");
	32
	33	MODULE_ALIAS("snd-timer-" __stringify(SNDRV_TIMER_GLOBAL_HRTIMER));
	34
	35	#define NANO_SEC 1000000000UL /* 10^9 in sec */
	36	static unsigned int resolution;
	37
	38	struct snd_hrtimer {
	39	struct snd_timer *timer;
	40	struct hrtimer hrt;
fcfdebe7	41	atomic_t running;
bbaf5e97 TI	42	};
	43
	44	static enum hrtimer_restart snd_hrtimer_callback(struct hrtimer *hrt)
	45	{
	46	struct snd_hrtimer *stime = container_of(hrt, struct snd_hrtimer, hrt);
	47	struct snd_timer *t = stime->timer;
b1d4f7f4	48	unsigned long oruns;
fcfdebe7 TI	49
	50	if (!atomic_read(&stime->running))
	51	return HRTIMER_NORESTART;
	52
b1d4f7f4 CL	53	oruns = hrtimer_forward_now(hrt, ns_to_ktime(t->sticks * resolution));
b1d4f7f4 CL	54	snd_timer_interrupt(stime->timer, t->sticks * oruns);
fcfdebe7 TI	55
	56	if (!atomic_read(&stime->running))
	57	return HRTIMER_NORESTART;
bbaf5e97 TI	58	return HRTIMER_RESTART;
	59	}
	60
	61	static int snd_hrtimer_open(struct snd_timer *t)
	62	{
	63	struct snd_hrtimer *stime;
	64
	65	stime = kmalloc(sizeof(*stime), GFP_KERNEL);
	66	if (!stime)
	67	return -ENOMEM;
	68	hrtimer_init(&stime->hrt, CLOCK_MONOTONIC, HRTIMER_MODE_REL);
	69	stime->timer = t;
bbaf5e97	70	stime->hrt.function = snd_hrtimer_callback;
fcfdebe7	71	atomic_set(&stime->running, 0);
bbaf5e97 TI	72	t->private_data = stime;
	73	return 0;
	74	}
	75
	76	static int snd_hrtimer_close(struct snd_timer *t)
	77	{
	78	struct snd_hrtimer *stime = t->private_data;
	79
	80	if (stime) {
	81	hrtimer_cancel(&stime->hrt);
	82	kfree(stime);
	83	t->private_data = NULL;
	84	}
	85	return 0;
	86	}
	87
	88	static int snd_hrtimer_start(struct snd_timer *t)
	89	{
	90	struct snd_hrtimer *stime = t->private_data;
	91
fcfdebe7	92	atomic_set(&stime->running, 0);
d24455ed	93	hrtimer_try_to_cancel(&stime->hrt);
647808a6	94	hrtimer_start(&stime->hrt, ns_to_ktime(t->sticks * resolution),
bbaf5e97	95	HRTIMER_MODE_REL);
fcfdebe7	96	atomic_set(&stime->running, 1);
bbaf5e97 TI	97	return 0;
	98	}
	99
	100	static int snd_hrtimer_stop(struct snd_timer *t)
	101	{
	102	struct snd_hrtimer *stime = t->private_data;
fcfdebe7	103	atomic_set(&stime->running, 0);
d24455ed	104	hrtimer_try_to_cancel(&stime->hrt);
bbaf5e97 TI	105	return 0;
	106	}
	107
	108	static struct snd_timer_hardware hrtimer_hw = {
2243c4d0	109	.flags = SNDRV_TIMER_HW_AUTO \| SNDRV_TIMER_HW_TASKLET,
bbaf5e97 TI	110	.open = snd_hrtimer_open,
	111	.close = snd_hrtimer_close,
	112	.start = snd_hrtimer_start,
	113	.stop = snd_hrtimer_stop,
	114	};
	115
	116	/*
	117	* entry functions
	118	*/
	119
	120	static struct snd_timer *mytimer;
	121
	122	static int __init snd_hrtimer_init(void)
	123	{
	124	struct snd_timer *timer;
	125	struct timespec tp;
	126	int err;
	127
	128	hrtimer_get_res(CLOCK_MONOTONIC, &tp);
	129	if (tp.tv_sec > 0 \|\| !tp.tv_nsec) {
	130	snd_printk(KERN_ERR
	131	"snd-hrtimer: Invalid resolution %u.%09u",
	132	(unsigned)tp.tv_sec, (unsigned)tp.tv_nsec);
	133	return -EINVAL;
	134	}
	135	resolution = tp.tv_nsec;
	136
	137	/* Create a new timer and set up the fields */
	138	err = snd_timer_global_new("hrtimer", SNDRV_TIMER_GLOBAL_HRTIMER,
	139	&timer);
	140	if (err < 0)
	141	return err;
	142
	143	timer->module = THIS_MODULE;
	144	strcpy(timer->name, "HR timer");
	145	timer->hw = hrtimer_hw;
	146	timer->hw.resolution = resolution;
	147	timer->hw.ticks = NANO_SEC / resolution;
	148
	149	err = snd_timer_global_register(timer);
	150	if (err < 0) {
	151	snd_timer_global_free(timer);
	152	return err;
	153	}
	154	mytimer = timer; /* remember this */
	155
	156	return 0;
	157	}
	158
	159	static void __exit snd_hrtimer_exit(void)
	160	{
	161	if (mytimer) {
	162	snd_timer_global_free(mytimer);
	163	mytimer = NULL;
	164	}
	165	}
	166
	167	module_init(snd_hrtimer_init);
	168	module_exit(snd_hrtimer_exit);