123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932 |
- /*
- * Timers abstract layer
- * Copyright (c) by Jaroslav Kysela <perex@suse.cz>
- *
- *
- * 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 <sound/driver.h>
- #include <linux/delay.h>
- #include <linux/init.h>
- #include <linux/smp_lock.h>
- #include <linux/slab.h>
- #include <linux/time.h>
- #include <linux/moduleparam.h>
- #include <linux/string.h>
- #include <sound/core.h>
- #include <sound/timer.h>
- #include <sound/control.h>
- #include <sound/info.h>
- #include <sound/minors.h>
- #include <sound/initval.h>
- #include <linux/kmod.h>
- #ifdef CONFIG_KERNELD
- #include <linux/kerneld.h>
- #endif
- #if defined(CONFIG_SND_HPET) || defined(CONFIG_SND_HPET_MODULE)
- #define DEFAULT_TIMER_LIMIT 3
- #elif defined(CONFIG_SND_RTCTIMER) || defined(CONFIG_SND_RTCTIMER_MODULE)
- #define DEFAULT_TIMER_LIMIT 2
- #else
- #define DEFAULT_TIMER_LIMIT 1
- #endif
- static int timer_limit = DEFAULT_TIMER_LIMIT;
- MODULE_AUTHOR("Jaroslav Kysela <perex@suse.cz>, Takashi Iwai <tiwai@suse.de>");
- MODULE_DESCRIPTION("ALSA timer interface");
- MODULE_LICENSE("GPL");
- module_param(timer_limit, int, 0444);
- MODULE_PARM_DESC(timer_limit, "Maximum global timers in system.");
- typedef struct {
- snd_timer_instance_t *timeri;
- int tread; /* enhanced read with timestamps and events */
- unsigned long ticks;
- unsigned long overrun;
- int qhead;
- int qtail;
- int qused;
- int queue_size;
- snd_timer_read_t *queue;
- snd_timer_tread_t *tqueue;
- spinlock_t qlock;
- unsigned long last_resolution;
- unsigned int filter;
- struct timespec tstamp; /* trigger tstamp */
- wait_queue_head_t qchange_sleep;
- struct fasync_struct *fasync;
- struct semaphore tread_sem;
- } snd_timer_user_t;
- /* list of timers */
- static LIST_HEAD(snd_timer_list);
- /* list of slave instances */
- static LIST_HEAD(snd_timer_slave_list);
- /* lock for slave active lists */
- static DEFINE_SPINLOCK(slave_active_lock);
- static DECLARE_MUTEX(register_mutex);
- static int snd_timer_free(snd_timer_t *timer);
- static int snd_timer_dev_free(snd_device_t *device);
- static int snd_timer_dev_register(snd_device_t *device);
- static int snd_timer_dev_unregister(snd_device_t *device);
- static void snd_timer_reschedule(snd_timer_t * timer, unsigned long ticks_left);
- /*
- * create a timer instance with the given owner string.
- * when timer is not NULL, increments the module counter
- */
- static snd_timer_instance_t *snd_timer_instance_new(char *owner, snd_timer_t *timer)
- {
- snd_timer_instance_t *timeri;
- timeri = kcalloc(1, sizeof(*timeri), GFP_KERNEL);
- if (timeri == NULL)
- return NULL;
- timeri->owner = kstrdup(owner, GFP_KERNEL);
- if (! timeri->owner) {
- kfree(timeri);
- return NULL;
- }
- INIT_LIST_HEAD(&timeri->open_list);
- INIT_LIST_HEAD(&timeri->active_list);
- INIT_LIST_HEAD(&timeri->ack_list);
- INIT_LIST_HEAD(&timeri->slave_list_head);
- INIT_LIST_HEAD(&timeri->slave_active_head);
- timeri->timer = timer;
- if (timer && timer->card && !try_module_get(timer->card->module)) {
- kfree(timeri->owner);
- kfree(timeri);
- return NULL;
- }
- return timeri;
- }
- /*
- * find a timer instance from the given timer id
- */
- static snd_timer_t *snd_timer_find(snd_timer_id_t *tid)
- {
- snd_timer_t *timer = NULL;
- struct list_head *p;
- list_for_each(p, &snd_timer_list) {
- timer = (snd_timer_t *)list_entry(p, snd_timer_t, device_list);
- if (timer->tmr_class != tid->dev_class)
- continue;
- if ((timer->tmr_class == SNDRV_TIMER_CLASS_CARD ||
- timer->tmr_class == SNDRV_TIMER_CLASS_PCM) &&
- (timer->card == NULL ||
- timer->card->number != tid->card))
- continue;
- if (timer->tmr_device != tid->device)
- continue;
- if (timer->tmr_subdevice != tid->subdevice)
- continue;
- return timer;
- }
- return NULL;
- }
- #ifdef CONFIG_KMOD
- static void snd_timer_request(snd_timer_id_t *tid)
- {
- if (! current->fs->root)
- return;
- switch (tid->dev_class) {
- case SNDRV_TIMER_CLASS_GLOBAL:
- if (tid->device < timer_limit)
- request_module("snd-timer-%i", tid->device);
- break;
- case SNDRV_TIMER_CLASS_CARD:
- case SNDRV_TIMER_CLASS_PCM:
- if (tid->card < snd_ecards_limit)
- request_module("snd-card-%i", tid->card);
- break;
- default:
- break;
- }
- }
- #endif
- /*
- * look for a master instance matching with the slave id of the given slave.
- * when found, relink the open_link of the slave.
- *
- * call this with register_mutex down.
- */
- static void snd_timer_check_slave(snd_timer_instance_t *slave)
- {
- snd_timer_t *timer;
- snd_timer_instance_t *master;
- struct list_head *p, *q;
- /* FIXME: it's really dumb to look up all entries.. */
- list_for_each(p, &snd_timer_list) {
- timer = (snd_timer_t *)list_entry(p, snd_timer_t, device_list);
- list_for_each(q, &timer->open_list_head) {
- master = (snd_timer_instance_t *)list_entry(q, snd_timer_instance_t, open_list);
- if (slave->slave_class == master->slave_class &&
- slave->slave_id == master->slave_id) {
- list_del(&slave->open_list);
- list_add_tail(&slave->open_list, &master->slave_list_head);
- spin_lock_irq(&slave_active_lock);
- slave->master = master;
- slave->timer = master->timer;
- spin_unlock_irq(&slave_active_lock);
- return;
- }
- }
- }
- }
- /*
- * look for slave instances matching with the slave id of the given master.
- * when found, relink the open_link of slaves.
- *
- * call this with register_mutex down.
- */
- static void snd_timer_check_master(snd_timer_instance_t *master)
- {
- snd_timer_instance_t *slave;
- struct list_head *p, *n;
- /* check all pending slaves */
- list_for_each_safe(p, n, &snd_timer_slave_list) {
- slave = (snd_timer_instance_t *)list_entry(p, snd_timer_instance_t, open_list);
- if (slave->slave_class == master->slave_class &&
- slave->slave_id == master->slave_id) {
- list_del(p);
- list_add_tail(p, &master->slave_list_head);
- spin_lock_irq(&slave_active_lock);
- slave->master = master;
- slave->timer = master->timer;
- if (slave->flags & SNDRV_TIMER_IFLG_RUNNING)
- list_add_tail(&slave->active_list, &master->slave_active_head);
- spin_unlock_irq(&slave_active_lock);
- }
- }
- }
- /*
- * open a timer instance
- * when opening a master, the slave id must be here given.
- */
- int snd_timer_open(snd_timer_instance_t **ti,
- char *owner, snd_timer_id_t *tid,
- unsigned int slave_id)
- {
- snd_timer_t *timer;
- snd_timer_instance_t *timeri = NULL;
-
- if (tid->dev_class == SNDRV_TIMER_CLASS_SLAVE) {
- /* open a slave instance */
- if (tid->dev_sclass <= SNDRV_TIMER_SCLASS_NONE ||
- tid->dev_sclass > SNDRV_TIMER_SCLASS_OSS_SEQUENCER) {
- snd_printd("invalid slave class %i\n", tid->dev_sclass);
- return -EINVAL;
- }
- down(®ister_mutex);
- timeri = snd_timer_instance_new(owner, NULL);
- timeri->slave_class = tid->dev_sclass;
- timeri->slave_id = tid->device;
- timeri->flags |= SNDRV_TIMER_IFLG_SLAVE;
- list_add_tail(&timeri->open_list, &snd_timer_slave_list);
- snd_timer_check_slave(timeri);
- up(®ister_mutex);
- *ti = timeri;
- return 0;
- }
- /* open a master instance */
- down(®ister_mutex);
- timer = snd_timer_find(tid);
- #ifdef CONFIG_KMOD
- if (timer == NULL) {
- up(®ister_mutex);
- snd_timer_request(tid);
- down(®ister_mutex);
- timer = snd_timer_find(tid);
- }
- #endif
- if (timer) {
- if (!list_empty(&timer->open_list_head)) {
- timeri = (snd_timer_instance_t *)list_entry(timer->open_list_head.next, snd_timer_instance_t, open_list);
- if (timeri->flags & SNDRV_TIMER_IFLG_EXCLUSIVE) {
- up(®ister_mutex);
- return -EBUSY;
- }
- }
- timeri = snd_timer_instance_new(owner, timer);
- if (timeri) {
- timeri->slave_class = tid->dev_sclass;
- timeri->slave_id = slave_id;
- if (list_empty(&timer->open_list_head) && timer->hw.open)
- timer->hw.open(timer);
- list_add_tail(&timeri->open_list, &timer->open_list_head);
- snd_timer_check_master(timeri);
- }
- } else {
- up(®ister_mutex);
- return -ENODEV;
- }
- up(®ister_mutex);
- *ti = timeri;
- return 0;
- }
- static int _snd_timer_stop(snd_timer_instance_t * timeri, int keep_flag, enum sndrv_timer_event event);
- /*
- * close a timer instance
- */
- int snd_timer_close(snd_timer_instance_t * timeri)
- {
- snd_timer_t *timer = NULL;
- struct list_head *p, *n;
- snd_timer_instance_t *slave;
- snd_assert(timeri != NULL, return -ENXIO);
- /* force to stop the timer */
- snd_timer_stop(timeri);
- if (timeri->flags & SNDRV_TIMER_IFLG_SLAVE) {
- /* wait, until the active callback is finished */
- spin_lock_irq(&slave_active_lock);
- while (timeri->flags & SNDRV_TIMER_IFLG_CALLBACK) {
- spin_unlock_irq(&slave_active_lock);
- udelay(10);
- spin_lock_irq(&slave_active_lock);
- }
- spin_unlock_irq(&slave_active_lock);
- down(®ister_mutex);
- list_del(&timeri->open_list);
- up(®ister_mutex);
- } else {
- timer = timeri->timer;
- /* wait, until the active callback is finished */
- spin_lock_irq(&timer->lock);
- while (timeri->flags & SNDRV_TIMER_IFLG_CALLBACK) {
- spin_unlock_irq(&timer->lock);
- udelay(10);
- spin_lock_irq(&timer->lock);
- }
- spin_unlock_irq(&timer->lock);
- down(®ister_mutex);
- list_del(&timeri->open_list);
- if (timer && list_empty(&timer->open_list_head) && timer->hw.close)
- timer->hw.close(timer);
- /* remove slave links */
- list_for_each_safe(p, n, &timeri->slave_list_head) {
- slave = (snd_timer_instance_t *)list_entry(p, snd_timer_instance_t, open_list);
- spin_lock_irq(&slave_active_lock);
- _snd_timer_stop(slave, 1, SNDRV_TIMER_EVENT_RESOLUTION);
- list_del(p);
- list_add_tail(p, &snd_timer_slave_list);
- slave->master = NULL;
- slave->timer = NULL;
- spin_unlock_irq(&slave_active_lock);
- }
- up(®ister_mutex);
- }
- if (timeri->private_free)
- timeri->private_free(timeri);
- kfree(timeri->owner);
- kfree(timeri);
- if (timer && timer->card)
- module_put(timer->card->module);
- return 0;
- }
- unsigned long snd_timer_resolution(snd_timer_instance_t * timeri)
- {
- snd_timer_t * timer;
- if (timeri == NULL)
- return 0;
- if ((timer = timeri->timer) != NULL) {
- if (timer->hw.c_resolution)
- return timer->hw.c_resolution(timer);
- return timer->hw.resolution;
- }
- return 0;
- }
- static void snd_timer_notify1(snd_timer_instance_t *ti, enum sndrv_timer_event event)
- {
- snd_timer_t *timer;
- unsigned long flags;
- unsigned long resolution = 0;
- snd_timer_instance_t *ts;
- struct list_head *n;
- struct timespec tstamp;
- snd_timestamp_now(&tstamp, 1);
- snd_assert(event >= SNDRV_TIMER_EVENT_START && event <= SNDRV_TIMER_EVENT_PAUSE, return);
- if (event == SNDRV_TIMER_EVENT_START || event == SNDRV_TIMER_EVENT_CONTINUE)
- resolution = snd_timer_resolution(ti);
- if (ti->ccallback)
- ti->ccallback(ti, SNDRV_TIMER_EVENT_START, &tstamp, resolution);
- if (ti->flags & SNDRV_TIMER_IFLG_SLAVE)
- return;
- timer = ti->timer;
- if (timer == NULL)
- return;
- if (timer->hw.flags & SNDRV_TIMER_HW_SLAVE)
- return;
- spin_lock_irqsave(&timer->lock, flags);
- list_for_each(n, &ti->slave_active_head) {
- ts = (snd_timer_instance_t *)list_entry(n, snd_timer_instance_t, active_list);
- if (ts->ccallback)
- ts->ccallback(ti, event + 100, &tstamp, resolution);
- }
- spin_unlock_irqrestore(&timer->lock, flags);
- }
- static int snd_timer_start1(snd_timer_t *timer, snd_timer_instance_t *timeri, unsigned long sticks)
- {
- list_del(&timeri->active_list);
- list_add_tail(&timeri->active_list, &timer->active_list_head);
- if (timer->running) {
- if (timer->hw.flags & SNDRV_TIMER_HW_SLAVE)
- goto __start_now;
- timer->flags |= SNDRV_TIMER_FLG_RESCHED;
- timeri->flags |= SNDRV_TIMER_IFLG_START;
- return 1; /* delayed start */
- } else {
- timer->sticks = sticks;
- timer->hw.start(timer);
- __start_now:
- timer->running++;
- timeri->flags |= SNDRV_TIMER_IFLG_RUNNING;
- return 0;
- }
- }
- static int snd_timer_start_slave(snd_timer_instance_t *timeri)
- {
- unsigned long flags;
- spin_lock_irqsave(&slave_active_lock, flags);
- timeri->flags |= SNDRV_TIMER_IFLG_RUNNING;
- if (timeri->master)
- list_add_tail(&timeri->active_list, &timeri->master->slave_active_head);
- spin_unlock_irqrestore(&slave_active_lock, flags);
- return 1; /* delayed start */
- }
- /*
- * start the timer instance
- */
- int snd_timer_start(snd_timer_instance_t * timeri, unsigned int ticks)
- {
- snd_timer_t *timer;
- int result = -EINVAL;
- unsigned long flags;
- if (timeri == NULL || ticks < 1)
- return -EINVAL;
- if (timeri->flags & SNDRV_TIMER_IFLG_SLAVE) {
- result = snd_timer_start_slave(timeri);
- snd_timer_notify1(timeri, SNDRV_TIMER_EVENT_START);
- return result;
- }
- timer = timeri->timer;
- if (timer == NULL)
- return -EINVAL;
- spin_lock_irqsave(&timer->lock, flags);
- timeri->ticks = timeri->cticks = ticks;
- timeri->pticks = 0;
- result = snd_timer_start1(timer, timeri, ticks);
- spin_unlock_irqrestore(&timer->lock, flags);
- snd_timer_notify1(timeri, SNDRV_TIMER_EVENT_START);
- return result;
- }
- static int _snd_timer_stop(snd_timer_instance_t * timeri, int keep_flag, enum sndrv_timer_event event)
- {
- snd_timer_t *timer;
- unsigned long flags;
- snd_assert(timeri != NULL, return -ENXIO);
- if (timeri->flags & SNDRV_TIMER_IFLG_SLAVE) {
- if (!keep_flag) {
- spin_lock_irqsave(&slave_active_lock, flags);
- timeri->flags &= ~SNDRV_TIMER_IFLG_RUNNING;
- spin_unlock_irqrestore(&slave_active_lock, flags);
- }
- goto __end;
- }
- timer = timeri->timer;
- if (!timer)
- return -EINVAL;
- spin_lock_irqsave(&timer->lock, flags);
- list_del_init(&timeri->ack_list);
- list_del_init(&timeri->active_list);
- if ((timeri->flags & SNDRV_TIMER_IFLG_RUNNING) &&
- !(--timer->running)) {
- timer->hw.stop(timer);
- if (timer->flags & SNDRV_TIMER_FLG_RESCHED) {
- timer->flags &= ~SNDRV_TIMER_FLG_RESCHED;
- snd_timer_reschedule(timer, 0);
- if (timer->flags & SNDRV_TIMER_FLG_CHANGE) {
- timer->flags &= ~SNDRV_TIMER_FLG_CHANGE;
- timer->hw.start(timer);
- }
- }
- }
- if (!keep_flag)
- timeri->flags &= ~(SNDRV_TIMER_IFLG_RUNNING|SNDRV_TIMER_IFLG_START);
- spin_unlock_irqrestore(&timer->lock, flags);
- __end:
- if (event != SNDRV_TIMER_EVENT_RESOLUTION)
- snd_timer_notify1(timeri, event);
- return 0;
- }
- /*
- * stop the timer instance.
- *
- * do not call this from the timer callback!
- */
- int snd_timer_stop(snd_timer_instance_t * timeri)
- {
- snd_timer_t *timer;
- unsigned long flags;
- int err;
- err = _snd_timer_stop(timeri, 0, SNDRV_TIMER_EVENT_STOP);
- if (err < 0)
- return err;
- timer = timeri->timer;
- spin_lock_irqsave(&timer->lock, flags);
- timeri->cticks = timeri->ticks;
- timeri->pticks = 0;
- spin_unlock_irqrestore(&timer->lock, flags);
- return 0;
- }
- /*
- * start again.. the tick is kept.
- */
- int snd_timer_continue(snd_timer_instance_t * timeri)
- {
- snd_timer_t *timer;
- int result = -EINVAL;
- unsigned long flags;
- if (timeri == NULL)
- return result;
- if (timeri->flags & SNDRV_TIMER_IFLG_SLAVE)
- return snd_timer_start_slave(timeri);
- timer = timeri->timer;
- if (! timer)
- return -EINVAL;
- spin_lock_irqsave(&timer->lock, flags);
- if (!timeri->cticks)
- timeri->cticks = 1;
- timeri->pticks = 0;
- result = snd_timer_start1(timer, timeri, timer->sticks);
- spin_unlock_irqrestore(&timer->lock, flags);
- snd_timer_notify1(timeri, SNDRV_TIMER_EVENT_CONTINUE);
- return result;
- }
- /*
- * pause.. remember the ticks left
- */
- int snd_timer_pause(snd_timer_instance_t * timeri)
- {
- return _snd_timer_stop(timeri, 0, SNDRV_TIMER_EVENT_PAUSE);
- }
- /*
- * reschedule the timer
- *
- * start pending instances and check the scheduling ticks.
- * when the scheduling ticks is changed set CHANGE flag to reprogram the timer.
- */
- static void snd_timer_reschedule(snd_timer_t * timer, unsigned long ticks_left)
- {
- snd_timer_instance_t *ti;
- unsigned long ticks = ~0UL;
- struct list_head *p;
- list_for_each(p, &timer->active_list_head) {
- ti = (snd_timer_instance_t *)list_entry(p, snd_timer_instance_t, active_list);
- if (ti->flags & SNDRV_TIMER_IFLG_START) {
- ti->flags &= ~SNDRV_TIMER_IFLG_START;
- ti->flags |= SNDRV_TIMER_IFLG_RUNNING;
- timer->running++;
- }
- if (ti->flags & SNDRV_TIMER_IFLG_RUNNING) {
- if (ticks > ti->cticks)
- ticks = ti->cticks;
- }
- }
- if (ticks == ~0UL) {
- timer->flags &= ~SNDRV_TIMER_FLG_RESCHED;
- return;
- }
- if (ticks > timer->hw.ticks)
- ticks = timer->hw.ticks;
- if (ticks_left != ticks)
- timer->flags |= SNDRV_TIMER_FLG_CHANGE;
- timer->sticks = ticks;
- }
- /*
- * timer tasklet
- *
- */
- static void snd_timer_tasklet(unsigned long arg)
- {
- snd_timer_t *timer = (snd_timer_t *) arg;
- snd_timer_instance_t *ti;
- struct list_head *p;
- unsigned long resolution, ticks;
- spin_lock(&timer->lock);
- /* now process all callbacks */
- while (!list_empty(&timer->sack_list_head)) {
- p = timer->sack_list_head.next; /* get first item */
- ti = (snd_timer_instance_t *)list_entry(p, snd_timer_instance_t, ack_list);
- /* remove from ack_list and make empty */
- list_del_init(p);
-
- ticks = ti->pticks;
- ti->pticks = 0;
- resolution = ti->resolution;
- ti->flags |= SNDRV_TIMER_IFLG_CALLBACK;
- spin_unlock(&timer->lock);
- if (ti->callback)
- ti->callback(ti, resolution, ticks);
- spin_lock(&timer->lock);
- ti->flags &= ~SNDRV_TIMER_IFLG_CALLBACK;
- }
- spin_unlock(&timer->lock);
- }
- /*
- * timer interrupt
- *
- * ticks_left is usually equal to timer->sticks.
- *
- */
- void snd_timer_interrupt(snd_timer_t * timer, unsigned long ticks_left)
- {
- snd_timer_instance_t *ti, *ts;
- unsigned long resolution, ticks;
- struct list_head *p, *q, *n;
- int use_tasklet = 0;
- if (timer == NULL)
- return;
- spin_lock(&timer->lock);
- /* remember the current resolution */
- if (timer->hw.c_resolution)
- resolution = timer->hw.c_resolution(timer);
- else
- resolution = timer->hw.resolution;
- /* loop for all active instances
- * here we cannot use list_for_each because the active_list of a processed
- * instance is relinked to done_list_head before callback is called.
- */
- list_for_each_safe(p, n, &timer->active_list_head) {
- ti = (snd_timer_instance_t *)list_entry(p, snd_timer_instance_t, active_list);
- if (!(ti->flags & SNDRV_TIMER_IFLG_RUNNING))
- continue;
- ti->pticks += ticks_left;
- ti->resolution = resolution;
- if (ti->cticks < ticks_left)
- ti->cticks = 0;
- else
- ti->cticks -= ticks_left;
- if (ti->cticks) /* not expired */
- continue;
- if (ti->flags & SNDRV_TIMER_IFLG_AUTO) {
- ti->cticks = ti->ticks;
- } else {
- ti->flags &= ~SNDRV_TIMER_IFLG_RUNNING;
- if (--timer->running)
- list_del(p);
- }
- if (list_empty(&ti->ack_list)) {
- if ((timer->hw.flags & SNDRV_TIMER_HW_TASKLET) ||
- (ti->flags & SNDRV_TIMER_IFLG_FAST)) {
- list_add_tail(&ti->ack_list, &timer->ack_list_head);
- } else {
- list_add_tail(&ti->ack_list, &timer->sack_list_head);
- }
- }
- list_for_each(q, &ti->slave_active_head) {
- ts = (snd_timer_instance_t *)list_entry(q, snd_timer_instance_t, active_list);
- ts->pticks = ti->pticks;
- ts->resolution = resolution;
- if (list_empty(&ts->ack_list)) {
- if ((timer->hw.flags & SNDRV_TIMER_HW_TASKLET) ||
- (ti->flags & SNDRV_TIMER_IFLG_FAST)) {
- list_add_tail(&ts->ack_list, &timer->ack_list_head);
- } else {
- list_add_tail(&ts->ack_list, &timer->sack_list_head);
- }
- }
- }
- }
- if (timer->flags & SNDRV_TIMER_FLG_RESCHED)
- snd_timer_reschedule(timer, ticks_left);
- if (timer->running) {
- if (timer->hw.flags & SNDRV_TIMER_HW_STOP) {
- timer->hw.stop(timer);
- timer->flags |= SNDRV_TIMER_FLG_CHANGE;
- }
- if (!(timer->hw.flags & SNDRV_TIMER_HW_AUTO) ||
- (timer->flags & SNDRV_TIMER_FLG_CHANGE)) {
- /* restart timer */
- timer->flags &= ~SNDRV_TIMER_FLG_CHANGE;
- timer->hw.start(timer);
- }
- } else {
- timer->hw.stop(timer);
- }
- /* now process all fast callbacks */
- while (!list_empty(&timer->ack_list_head)) {
- p = timer->ack_list_head.next; /* get first item */
- ti = (snd_timer_instance_t *)list_entry(p, snd_timer_instance_t, ack_list);
-
- /* remove from ack_list and make empty */
- list_del_init(p);
-
- ticks = ti->pticks;
- ti->pticks = 0;
- ti->flags |= SNDRV_TIMER_IFLG_CALLBACK;
- spin_unlock(&timer->lock);
- if (ti->callback)
- ti->callback(ti, resolution, ticks);
- spin_lock(&timer->lock);
- ti->flags &= ~SNDRV_TIMER_IFLG_CALLBACK;
- }
- /* do we have any slow callbacks? */
- use_tasklet = !list_empty(&timer->sack_list_head);
- spin_unlock(&timer->lock);
- if (use_tasklet)
- tasklet_hi_schedule(&timer->task_queue);
- }
- /*
- */
- int snd_timer_new(snd_card_t *card, char *id, snd_timer_id_t *tid, snd_timer_t ** rtimer)
- {
- snd_timer_t *timer;
- int err;
- static snd_device_ops_t ops = {
- .dev_free = snd_timer_dev_free,
- .dev_register = snd_timer_dev_register,
- .dev_unregister = snd_timer_dev_unregister
- };
- snd_assert(tid != NULL, return -EINVAL);
- snd_assert(rtimer != NULL, return -EINVAL);
- *rtimer = NULL;
- timer = kcalloc(1, sizeof(*timer), GFP_KERNEL);
- if (timer == NULL)
- return -ENOMEM;
- timer->tmr_class = tid->dev_class;
- timer->card = card;
- timer->tmr_device = tid->device;
- timer->tmr_subdevice = tid->subdevice;
- if (id)
- strlcpy(timer->id, id, sizeof(timer->id));
- INIT_LIST_HEAD(&timer->device_list);
- INIT_LIST_HEAD(&timer->open_list_head);
- INIT_LIST_HEAD(&timer->active_list_head);
- INIT_LIST_HEAD(&timer->ack_list_head);
- INIT_LIST_HEAD(&timer->sack_list_head);
- spin_lock_init(&timer->lock);
- tasklet_init(&timer->task_queue, snd_timer_tasklet, (unsigned long)timer);
- if (card != NULL) {
- if ((err = snd_device_new(card, SNDRV_DEV_TIMER, timer, &ops)) < 0) {
- snd_timer_free(timer);
- return err;
- }
- }
- *rtimer = timer;
- return 0;
- }
- static int snd_timer_free(snd_timer_t *timer)
- {
- snd_assert(timer != NULL, return -ENXIO);
- if (timer->private_free)
- timer->private_free(timer);
- kfree(timer);
- return 0;
- }
- int snd_timer_dev_free(snd_device_t *device)
- {
- snd_timer_t *timer = device->device_data;
- return snd_timer_free(timer);
- }
- int snd_timer_dev_register(snd_device_t *dev)
- {
- snd_timer_t *timer = dev->device_data;
- snd_timer_t *timer1;
- struct list_head *p;
- snd_assert(timer != NULL && timer->hw.start != NULL && timer->hw.stop != NULL, return -ENXIO);
- if (!(timer->hw.flags & SNDRV_TIMER_HW_SLAVE) &&
- !timer->hw.resolution && timer->hw.c_resolution == NULL)
- return -EINVAL;
- down(®ister_mutex);
- list_for_each(p, &snd_timer_list) {
- timer1 = (snd_timer_t *)list_entry(p, snd_timer_t, device_list);
- if (timer1->tmr_class > timer->tmr_class)
- break;
- if (timer1->tmr_class < timer->tmr_class)
- continue;
- if (timer1->card && timer->card) {
- if (timer1->card->number > timer->card->number)
- break;
- if (timer1->card->number < timer->card->number)
- continue;
- }
- if (timer1->tmr_device > timer->tmr_device)
- break;
- if (timer1->tmr_device < timer->tmr_device)
- continue;
- if (timer1->tmr_subdevice > timer->tmr_subdevice)
- break;
- if (timer1->tmr_subdevice < timer->tmr_subdevice)
- continue;
- /* conflicts.. */
- up(®ister_mutex);
- return -EBUSY;
- }
- list_add_tail(&timer->device_list, p);
- up(®ister_mutex);
- return 0;
- }
- static int snd_timer_unregister(snd_timer_t *timer)
- {
- struct list_head *p, *n;
- snd_timer_instance_t *ti;
- snd_assert(timer != NULL, return -ENXIO);
- down(®ister_mutex);
- if (! list_empty(&timer->open_list_head)) {
- snd_printk(KERN_WARNING "timer 0x%lx is busy?\n", (long)timer);
- list_for_each_safe(p, n, &timer->open_list_head) {
- list_del_init(p);
- ti = (snd_timer_instance_t *)list_entry(p, snd_timer_instance_t, open_list);
- ti->timer = NULL;
- }
- }
- list_del(&timer->device_list);
- up(®ister_mutex);
- return snd_timer_free(timer);
- }
- static int snd_timer_dev_unregister(snd_device_t *device)
- {
- snd_timer_t *timer = device->device_data;
- return snd_timer_unregister(timer);
- }
- void snd_timer_notify(snd_timer_t *timer, enum sndrv_timer_event event, struct timespec *tstamp)
- {
- unsigned long flags;
- unsigned long resolution = 0;
- snd_timer_instance_t *ti, *ts;
- struct list_head *p, *n;
- snd_runtime_check(timer->hw.flags & SNDRV_TIMER_HW_SLAVE, return);
- snd_assert(event >= SNDRV_TIMER_EVENT_MSTART && event <= SNDRV_TIMER_EVENT_MPAUSE, return);
- spin_lock_irqsave(&timer->lock, flags);
- if (event == SNDRV_TIMER_EVENT_MSTART || event == SNDRV_TIMER_EVENT_MCONTINUE) {
- if (timer->hw.c_resolution)
- resolution = timer->hw.c_resolution(timer);
- else
- resolution = timer->hw.resolution;
- }
- list_for_each(p, &timer->active_list_head) {
- ti = (snd_timer_instance_t *)list_entry(p, snd_timer_instance_t, active_list);
- if (ti->ccallback)
- ti->ccallback(ti, event, tstamp, resolution);
- list_for_each(n, &ti->slave_active_head) {
- ts = (snd_timer_instance_t *)list_entry(n, snd_timer_instance_t, active_list);
- if (ts->ccallback)
- ts->ccallback(ts, event, tstamp, resolution);
- }
- }
- spin_unlock_irqrestore(&timer->lock, flags);
- }
- /*
- * exported functions for global timers
- */
- int snd_timer_global_new(char *id, int device, snd_timer_t **rtimer)
- {
- snd_timer_id_t tid;
-
- tid.dev_class = SNDRV_TIMER_CLASS_GLOBAL;
- tid.dev_sclass = SNDRV_TIMER_SCLASS_NONE;
- tid.card = -1;
- tid.device = device;
- tid.subdevice = 0;
- return snd_timer_new(NULL, id, &tid, rtimer);
- }
- int snd_timer_global_free(snd_timer_t *timer)
- {
- return snd_timer_free(timer);
- }
- int snd_timer_global_register(snd_timer_t *timer)
- {
- snd_device_t dev;
- memset(&dev, 0, sizeof(dev));
- dev.device_data = timer;
- return snd_timer_dev_register(&dev);
- }
- int snd_timer_global_unregister(snd_timer_t *timer)
- {
- return snd_timer_unregister(timer);
- }
- /*
- * System timer
- */
- struct snd_timer_system_private {
- struct timer_list tlist;
- struct timer * timer;
- unsigned long last_expires;
- unsigned long last_jiffies;
- unsigned long correction;
- };
- static void snd_timer_s_function(unsigned long data)
- {
- snd_timer_t *timer = (snd_timer_t *)data;
- struct snd_timer_system_private *priv = timer->private_data;
- unsigned long jiff = jiffies;
- if (time_after(jiff, priv->last_expires))
- priv->correction = (long)jiff - (long)priv->last_expires;
- snd_timer_interrupt(timer, (long)jiff - (long)priv->last_jiffies);
- }
- static int snd_timer_s_start(snd_timer_t * timer)
- {
- struct snd_timer_system_private *priv;
- unsigned long njiff;
- priv = (struct snd_timer_system_private *) timer->private_data;
- njiff = (priv->last_jiffies = jiffies);
- if (priv->correction > timer->sticks - 1) {
- priv->correction -= timer->sticks - 1;
- njiff++;
- } else {
- njiff += timer->sticks - priv->correction;
- priv->correction -= timer->sticks;
- }
- priv->last_expires = priv->tlist.expires = njiff;
- add_timer(&priv->tlist);
- return 0;
- }
- static int snd_timer_s_stop(snd_timer_t * timer)
- {
- struct snd_timer_system_private *priv;
- unsigned long jiff;
- priv = (struct snd_timer_system_private *) timer->private_data;
- del_timer(&priv->tlist);
- jiff = jiffies;
- if (time_before(jiff, priv->last_expires))
- timer->sticks = priv->last_expires - jiff;
- else
- timer->sticks = 1;
- return 0;
- }
- static struct _snd_timer_hardware snd_timer_system =
- {
- .flags = SNDRV_TIMER_HW_FIRST | SNDRV_TIMER_HW_TASKLET,
- .resolution = 1000000000L / HZ,
- .ticks = 10000000L,
- .start = snd_timer_s_start,
- .stop = snd_timer_s_stop
- };
- static void snd_timer_free_system(snd_timer_t *timer)
- {
- kfree(timer->private_data);
- }
- static int snd_timer_register_system(void)
- {
- snd_timer_t *timer;
- struct snd_timer_system_private *priv;
- int err;
- if ((err = snd_timer_global_new("system", SNDRV_TIMER_GLOBAL_SYSTEM, &timer)) < 0)
- return err;
- strcpy(timer->name, "system timer");
- timer->hw = snd_timer_system;
- priv = kcalloc(1, sizeof(*priv), GFP_KERNEL);
- if (priv == NULL) {
- snd_timer_free(timer);
- return -ENOMEM;
- }
- init_timer(&priv->tlist);
- priv->tlist.function = snd_timer_s_function;
- priv->tlist.data = (unsigned long) timer;
- timer->private_data = priv;
- timer->private_free = snd_timer_free_system;
- return snd_timer_global_register(timer);
- }
- /*
- * Info interface
- */
- static void snd_timer_proc_read(snd_info_entry_t *entry,
- snd_info_buffer_t * buffer)
- {
- unsigned long flags;
- snd_timer_t *timer;
- snd_timer_instance_t *ti;
- struct list_head *p, *q;
- down(®ister_mutex);
- list_for_each(p, &snd_timer_list) {
- timer = (snd_timer_t *)list_entry(p, snd_timer_t, device_list);
- switch (timer->tmr_class) {
- case SNDRV_TIMER_CLASS_GLOBAL:
- snd_iprintf(buffer, "G%i: ", timer->tmr_device);
- break;
- case SNDRV_TIMER_CLASS_CARD:
- snd_iprintf(buffer, "C%i-%i: ", timer->card->number, timer->tmr_device);
- break;
- case SNDRV_TIMER_CLASS_PCM:
- snd_iprintf(buffer, "P%i-%i-%i: ", timer->card->number, timer->tmr_device, timer->tmr_subdevice);
- break;
- default:
- snd_iprintf(buffer, "?%i-%i-%i-%i: ", timer->tmr_class, timer->card ? timer->card->number : -1, timer->tmr_device, timer->tmr_subdevice);
- }
- snd_iprintf(buffer, "%s :", timer->name);
- if (timer->hw.resolution)
- snd_iprintf(buffer, " %lu.%03luus (%lu ticks)", timer->hw.resolution / 1000, timer->hw.resolution % 1000, timer->hw.ticks);
- if (timer->hw.flags & SNDRV_TIMER_HW_SLAVE)
- snd_iprintf(buffer, " SLAVE");
- snd_iprintf(buffer, "\n");
- spin_lock_irqsave(&timer->lock, flags);
- list_for_each(q, &timer->open_list_head) {
- ti = (snd_timer_instance_t *)list_entry(q, snd_timer_instance_t, open_list);
- snd_iprintf(buffer, " Client %s : %s : lost interrupts %li\n",
- ti->owner ? ti->owner : "unknown",
- ti->flags & (SNDRV_TIMER_IFLG_START|SNDRV_TIMER_IFLG_RUNNING) ? "running" : "stopped",
- ti->lost);
- }
- spin_unlock_irqrestore(&timer->lock, flags);
- }
- up(®ister_mutex);
- }
- /*
- * USER SPACE interface
- */
- static void snd_timer_user_interrupt(snd_timer_instance_t *timeri,
- unsigned long resolution,
- unsigned long ticks)
- {
- snd_timer_user_t *tu = timeri->callback_data;
- snd_timer_read_t *r;
- int prev;
-
- spin_lock(&tu->qlock);
- if (tu->qused > 0) {
- prev = tu->qtail == 0 ? tu->queue_size - 1 : tu->qtail - 1;
- r = &tu->queue[prev];
- if (r->resolution == resolution) {
- r->ticks += ticks;
- goto __wake;
- }
- }
- if (tu->qused >= tu->queue_size) {
- tu->overrun++;
- } else {
- r = &tu->queue[tu->qtail++];
- tu->qtail %= tu->queue_size;
- r->resolution = resolution;
- r->ticks = ticks;
- tu->qused++;
- }
- __wake:
- spin_unlock(&tu->qlock);
- kill_fasync(&tu->fasync, SIGIO, POLL_IN);
- wake_up(&tu->qchange_sleep);
- }
- static void snd_timer_user_append_to_tqueue(snd_timer_user_t *tu, snd_timer_tread_t *tread)
- {
- if (tu->qused >= tu->queue_size) {
- tu->overrun++;
- } else {
- memcpy(&tu->tqueue[tu->qtail++], tread, sizeof(*tread));
- tu->qtail %= tu->queue_size;
- tu->qused++;
- }
- }
- static void snd_timer_user_ccallback(snd_timer_instance_t *timeri,
- enum sndrv_timer_event event,
- struct timespec *tstamp,
- unsigned long resolution)
- {
- snd_timer_user_t *tu = timeri->callback_data;
- snd_timer_tread_t r1;
- if (event >= SNDRV_TIMER_EVENT_START && event <= SNDRV_TIMER_EVENT_PAUSE)
- tu->tstamp = *tstamp;
- if ((tu->filter & (1 << event)) == 0 || !tu->tread)
- return;
- r1.event = event;
- r1.tstamp = *tstamp;
- r1.val = resolution;
- spin_lock(&tu->qlock);
- snd_timer_user_append_to_tqueue(tu, &r1);
- spin_unlock(&tu->qlock);
- kill_fasync(&tu->fasync, SIGIO, POLL_IN);
- wake_up(&tu->qchange_sleep);
- }
- static void snd_timer_user_tinterrupt(snd_timer_instance_t *timeri,
- unsigned long resolution,
- unsigned long ticks)
- {
- snd_timer_user_t *tu = timeri->callback_data;
- snd_timer_tread_t *r, r1;
- struct timespec tstamp;
- int prev, append = 0;
- snd_timestamp_zero(&tstamp);
- spin_lock(&tu->qlock);
- if ((tu->filter & ((1 << SNDRV_TIMER_EVENT_RESOLUTION)|(1 << SNDRV_TIMER_EVENT_TICK))) == 0) {
- spin_unlock(&tu->qlock);
- return;
- }
- if (tu->last_resolution != resolution || ticks > 0)
- snd_timestamp_now(&tstamp, 1);
- if ((tu->filter & (1 << SNDRV_TIMER_EVENT_RESOLUTION)) && tu->last_resolution != resolution) {
- r1.event = SNDRV_TIMER_EVENT_RESOLUTION;
- r1.tstamp = tstamp;
- r1.val = resolution;
- snd_timer_user_append_to_tqueue(tu, &r1);
- tu->last_resolution = resolution;
- append++;
- }
- if ((tu->filter & (1 << SNDRV_TIMER_EVENT_TICK)) == 0)
- goto __wake;
- if (ticks == 0)
- goto __wake;
- if (tu->qused > 0) {
- prev = tu->qtail == 0 ? tu->queue_size - 1 : tu->qtail - 1;
- r = &tu->tqueue[prev];
- if (r->event == SNDRV_TIMER_EVENT_TICK) {
- r->tstamp = tstamp;
- r->val += ticks;
- append++;
- goto __wake;
- }
- }
- r1.event = SNDRV_TIMER_EVENT_TICK;
- r1.tstamp = tstamp;
- r1.val = ticks;
- snd_timer_user_append_to_tqueue(tu, &r1);
- append++;
- __wake:
- spin_unlock(&tu->qlock);
- if (append == 0)
- return;
- kill_fasync(&tu->fasync, SIGIO, POLL_IN);
- wake_up(&tu->qchange_sleep);
- }
- static int snd_timer_user_open(struct inode *inode, struct file *file)
- {
- snd_timer_user_t *tu;
-
- tu = kcalloc(1, sizeof(*tu), GFP_KERNEL);
- if (tu == NULL)
- return -ENOMEM;
- spin_lock_init(&tu->qlock);
- init_waitqueue_head(&tu->qchange_sleep);
- init_MUTEX(&tu->tread_sem);
- tu->ticks = 1;
- tu->queue_size = 128;
- tu->queue = (snd_timer_read_t *)kmalloc(tu->queue_size * sizeof(snd_timer_read_t), GFP_KERNEL);
- if (tu->queue == NULL) {
- kfree(tu);
- return -ENOMEM;
- }
- file->private_data = tu;
- return 0;
- }
- static int snd_timer_user_release(struct inode *inode, struct file *file)
- {
- snd_timer_user_t *tu;
- if (file->private_data) {
- tu = file->private_data;
- file->private_data = NULL;
- fasync_helper(-1, file, 0, &tu->fasync);
- if (tu->timeri)
- snd_timer_close(tu->timeri);
- kfree(tu->queue);
- kfree(tu->tqueue);
- kfree(tu);
- }
- return 0;
- }
- static void snd_timer_user_zero_id(snd_timer_id_t *id)
- {
- id->dev_class = SNDRV_TIMER_CLASS_NONE;
- id->dev_sclass = SNDRV_TIMER_SCLASS_NONE;
- id->card = -1;
- id->device = -1;
- id->subdevice = -1;
- }
- static void snd_timer_user_copy_id(snd_timer_id_t *id, snd_timer_t *timer)
- {
- id->dev_class = timer->tmr_class;
- id->dev_sclass = SNDRV_TIMER_SCLASS_NONE;
- id->card = timer->card ? timer->card->number : -1;
- id->device = timer->tmr_device;
- id->subdevice = timer->tmr_subdevice;
- }
- static int snd_timer_user_next_device(snd_timer_id_t __user *_tid)
- {
- snd_timer_id_t id;
- snd_timer_t *timer;
- struct list_head *p;
-
- if (copy_from_user(&id, _tid, sizeof(id)))
- return -EFAULT;
- down(®ister_mutex);
- if (id.dev_class < 0) { /* first item */
- if (list_empty(&snd_timer_list))
- snd_timer_user_zero_id(&id);
- else {
- timer = (snd_timer_t *)list_entry(snd_timer_list.next, snd_timer_t, device_list);
- snd_timer_user_copy_id(&id, timer);
- }
- } else {
- switch (id.dev_class) {
- case SNDRV_TIMER_CLASS_GLOBAL:
- id.device = id.device < 0 ? 0 : id.device + 1;
- list_for_each(p, &snd_timer_list) {
- timer = (snd_timer_t *)list_entry(p, snd_timer_t, device_list);
- if (timer->tmr_class > SNDRV_TIMER_CLASS_GLOBAL) {
- snd_timer_user_copy_id(&id, timer);
- break;
- }
- if (timer->tmr_device >= id.device) {
- snd_timer_user_copy_id(&id, timer);
- break;
- }
- }
- if (p == &snd_timer_list)
- snd_timer_user_zero_id(&id);
- break;
- case SNDRV_TIMER_CLASS_CARD:
- case SNDRV_TIMER_CLASS_PCM:
- if (id.card < 0) {
- id.card = 0;
- } else {
- if (id.card < 0) {
- id.card = 0;
- } else {
- if (id.device < 0) {
- id.device = 0;
- } else {
- id.subdevice = id.subdevice < 0 ? 0 : id.subdevice + 1;
- }
- }
- }
- list_for_each(p, &snd_timer_list) {
- timer = (snd_timer_t *)list_entry(p, snd_timer_t, device_list);
- if (timer->tmr_class > id.dev_class) {
- snd_timer_user_copy_id(&id, timer);
- break;
- }
- if (timer->tmr_class < id.dev_class)
- continue;
- if (timer->card->number > id.card) {
- snd_timer_user_copy_id(&id, timer);
- break;
- }
- if (timer->card->number < id.card)
- continue;
- if (timer->tmr_device > id.device) {
- snd_timer_user_copy_id(&id, timer);
- break;
- }
- if (timer->tmr_device < id.device)
- continue;
- if (timer->tmr_subdevice > id.subdevice) {
- snd_timer_user_copy_id(&id, timer);
- break;
- }
- if (timer->tmr_subdevice < id.subdevice)
- continue;
- snd_timer_user_copy_id(&id, timer);
- break;
- }
- if (p == &snd_timer_list)
- snd_timer_user_zero_id(&id);
- break;
- default:
- snd_timer_user_zero_id(&id);
- }
- }
- up(®ister_mutex);
- if (copy_to_user(_tid, &id, sizeof(*_tid)))
- return -EFAULT;
- return 0;
- }
- static int snd_timer_user_ginfo(struct file *file, snd_timer_ginfo_t __user *_ginfo)
- {
- snd_timer_ginfo_t *ginfo;
- snd_timer_id_t tid;
- snd_timer_t *t;
- struct list_head *p;
- int err = 0;
- ginfo = kmalloc(sizeof(*ginfo), GFP_KERNEL);
- if (! ginfo)
- return -ENOMEM;
- if (copy_from_user(ginfo, _ginfo, sizeof(*ginfo))) {
- kfree(ginfo);
- return -EFAULT;
- }
- tid = ginfo->tid;
- memset(ginfo, 0, sizeof(*ginfo));
- ginfo->tid = tid;
- down(®ister_mutex);
- t = snd_timer_find(&tid);
- if (t != NULL) {
- ginfo->card = t->card ? t->card->number : -1;
- if (t->hw.flags & SNDRV_TIMER_HW_SLAVE)
- ginfo->flags |= SNDRV_TIMER_FLG_SLAVE;
- strlcpy(ginfo->id, t->id, sizeof(ginfo->id));
- strlcpy(ginfo->name, t->name, sizeof(ginfo->name));
- ginfo->resolution = t->hw.resolution;
- if (t->hw.resolution_min > 0) {
- ginfo->resolution_min = t->hw.resolution_min;
- ginfo->resolution_max = t->hw.resolution_max;
- }
- list_for_each(p, &t->open_list_head) {
- ginfo->clients++;
- }
- } else {
- err = -ENODEV;
- }
- up(®ister_mutex);
- if (err >= 0 && copy_to_user(_ginfo, ginfo, sizeof(*ginfo)))
- err = -EFAULT;
- kfree(ginfo);
- return err;
- }
- static int snd_timer_user_gparams(struct file *file, snd_timer_gparams_t __user *_gparams)
- {
- snd_timer_gparams_t gparams;
- snd_timer_t *t;
- int err;
- if (copy_from_user(&gparams, _gparams, sizeof(gparams)))
- return -EFAULT;
- down(®ister_mutex);
- t = snd_timer_find(&gparams.tid);
- if (t != NULL) {
- if (list_empty(&t->open_list_head)) {
- if (t->hw.set_period)
- err = t->hw.set_period(t, gparams.period_num, gparams.period_den);
- else
- err = -ENOSYS;
- } else {
- err = -EBUSY;
- }
- } else {
- err = -ENODEV;
- }
- up(®ister_mutex);
- return err;
- }
- static int snd_timer_user_gstatus(struct file *file, snd_timer_gstatus_t __user *_gstatus)
- {
- snd_timer_gstatus_t gstatus;
- snd_timer_id_t tid;
- snd_timer_t *t;
- int err = 0;
- if (copy_from_user(&gstatus, _gstatus, sizeof(gstatus)))
- return -EFAULT;
- tid = gstatus.tid;
- memset(&gstatus, 0, sizeof(gstatus));
- gstatus.tid = tid;
- down(®ister_mutex);
- t = snd_timer_find(&tid);
- if (t != NULL) {
- if (t->hw.c_resolution)
- gstatus.resolution = t->hw.c_resolution(t);
- else
- gstatus.resolution = t->hw.resolution;
- if (t->hw.precise_resolution) {
- t->hw.precise_resolution(t, &gstatus.resolution_num, &gstatus.resolution_den);
- } else {
- gstatus.resolution_num = gstatus.resolution;
- gstatus.resolution_den = 1000000000uL;
- }
- } else {
- err = -ENODEV;
- }
- up(®ister_mutex);
- if (err >= 0 && copy_to_user(_gstatus, &gstatus, sizeof(gstatus)))
- err = -EFAULT;
- return err;
- }
- static int snd_timer_user_tselect(struct file *file, snd_timer_select_t __user *_tselect)
- {
- snd_timer_user_t *tu;
- snd_timer_select_t tselect;
- char str[32];
- int err = 0;
-
- tu = file->private_data;
- down(&tu->tread_sem);
- if (tu->timeri) {
- snd_timer_close(tu->timeri);
- tu->timeri = NULL;
- }
- if (copy_from_user(&tselect, _tselect, sizeof(tselect))) {
- err = -EFAULT;
- goto __err;
- }
- sprintf(str, "application %i", current->pid);
- if (tselect.id.dev_class != SNDRV_TIMER_CLASS_SLAVE)
- tselect.id.dev_sclass = SNDRV_TIMER_SCLASS_APPLICATION;
- if ((err = snd_timer_open(&tu->timeri, str, &tselect.id, current->pid)) < 0)
- goto __err;
- kfree(tu->queue);
- tu->queue = NULL;
- kfree(tu->tqueue);
- tu->tqueue = NULL;
- if (tu->tread) {
- tu->tqueue = (snd_timer_tread_t *)kmalloc(tu->queue_size * sizeof(snd_timer_tread_t), GFP_KERNEL);
- if (tu->tqueue == NULL)
- err = -ENOMEM;
- } else {
- tu->queue = (snd_timer_read_t *)kmalloc(tu->queue_size * sizeof(snd_timer_read_t), GFP_KERNEL);
- if (tu->queue == NULL)
- err = -ENOMEM;
- }
-
- if (err < 0) {
- snd_timer_close(tu->timeri);
- tu->timeri = NULL;
- } else {
- tu->timeri->flags |= SNDRV_TIMER_IFLG_FAST;
- tu->timeri->callback = tu->tread ? snd_timer_user_tinterrupt : snd_timer_user_interrupt;
- tu->timeri->ccallback = snd_timer_user_ccallback;
- tu->timeri->callback_data = (void *)tu;
- }
- __err:
- up(&tu->tread_sem);
- return err;
- }
- static int snd_timer_user_info(struct file *file, snd_timer_info_t __user *_info)
- {
- snd_timer_user_t *tu;
- snd_timer_info_t *info;
- snd_timer_t *t;
- int err = 0;
- tu = file->private_data;
- snd_assert(tu->timeri != NULL, return -ENXIO);
- t = tu->timeri->timer;
- snd_assert(t != NULL, return -ENXIO);
- info = kcalloc(1, sizeof(*info), GFP_KERNEL);
- if (! info)
- return -ENOMEM;
- info->card = t->card ? t->card->number : -1;
- if (t->hw.flags & SNDRV_TIMER_HW_SLAVE)
- info->flags |= SNDRV_TIMER_FLG_SLAVE;
- strlcpy(info->id, t->id, sizeof(info->id));
- strlcpy(info->name, t->name, sizeof(info->name));
- info->resolution = t->hw.resolution;
- if (copy_to_user(_info, info, sizeof(*_info)))
- err = -EFAULT;
- kfree(info);
- return err;
- }
- static int snd_timer_user_params(struct file *file, snd_timer_params_t __user *_params)
- {
- snd_timer_user_t *tu;
- snd_timer_params_t params;
- snd_timer_t *t;
- snd_timer_read_t *tr;
- snd_timer_tread_t *ttr;
- int err;
-
- tu = file->private_data;
- snd_assert(tu->timeri != NULL, return -ENXIO);
- t = tu->timeri->timer;
- snd_assert(t != NULL, return -ENXIO);
- if (copy_from_user(¶ms, _params, sizeof(params)))
- return -EFAULT;
- if (!(t->hw.flags & SNDRV_TIMER_HW_SLAVE) && params.ticks < 1) {
- err = -EINVAL;
- goto _end;
- }
- if (params.queue_size > 0 && (params.queue_size < 32 || params.queue_size > 1024)) {
- err = -EINVAL;
- goto _end;
- }
- if (params.filter & ~((1<<SNDRV_TIMER_EVENT_RESOLUTION)|
- (1<<SNDRV_TIMER_EVENT_TICK)|
- (1<<SNDRV_TIMER_EVENT_START)|
- (1<<SNDRV_TIMER_EVENT_STOP)|
- (1<<SNDRV_TIMER_EVENT_CONTINUE)|
- (1<<SNDRV_TIMER_EVENT_PAUSE)|
- (1<<SNDRV_TIMER_EVENT_MSTART)|
- (1<<SNDRV_TIMER_EVENT_MSTOP)|
- (1<<SNDRV_TIMER_EVENT_MCONTINUE)|
- (1<<SNDRV_TIMER_EVENT_MPAUSE))) {
- err = -EINVAL;
- goto _end;
- }
- snd_timer_stop(tu->timeri);
- spin_lock_irq(&t->lock);
- tu->timeri->flags &= ~(SNDRV_TIMER_IFLG_AUTO|
- SNDRV_TIMER_IFLG_EXCLUSIVE|
- SNDRV_TIMER_IFLG_EARLY_EVENT);
- if (params.flags & SNDRV_TIMER_PSFLG_AUTO)
- tu->timeri->flags |= SNDRV_TIMER_IFLG_AUTO;
- if (params.flags & SNDRV_TIMER_PSFLG_EXCLUSIVE)
- tu->timeri->flags |= SNDRV_TIMER_IFLG_EXCLUSIVE;
- if (params.flags & SNDRV_TIMER_PSFLG_EARLY_EVENT)
- tu->timeri->flags |= SNDRV_TIMER_IFLG_EARLY_EVENT;
- spin_unlock_irq(&t->lock);
- if (params.queue_size > 0 && (unsigned int)tu->queue_size != params.queue_size) {
- if (tu->tread) {
- ttr = (snd_timer_tread_t *)kmalloc(params.queue_size * sizeof(snd_timer_tread_t), GFP_KERNEL);
- if (ttr) {
- kfree(tu->tqueue);
- tu->queue_size = params.queue_size;
- tu->tqueue = ttr;
- }
- } else {
- tr = (snd_timer_read_t *)kmalloc(params.queue_size * sizeof(snd_timer_read_t), GFP_KERNEL);
- if (tr) {
- kfree(tu->queue);
- tu->queue_size = params.queue_size;
- tu->queue = tr;
- }
- }
- }
- tu->qhead = tu->qtail = tu->qused = 0;
- if (tu->timeri->flags & SNDRV_TIMER_IFLG_EARLY_EVENT) {
- if (tu->tread) {
- snd_timer_tread_t tread;
- tread.event = SNDRV_TIMER_EVENT_EARLY;
- tread.tstamp.tv_sec = 0;
- tread.tstamp.tv_nsec = 0;
- tread.val = 0;
- snd_timer_user_append_to_tqueue(tu, &tread);
- } else {
- snd_timer_read_t *r = &tu->queue[0];
- r->resolution = 0;
- r->ticks = 0;
- tu->qused++;
- tu->qtail++;
- }
-
- }
- tu->filter = params.filter;
- tu->ticks = params.ticks;
- err = 0;
- _end:
- if (copy_to_user(_params, ¶ms, sizeof(params)))
- return -EFAULT;
- return err;
- }
- static int snd_timer_user_status(struct file *file, snd_timer_status_t __user *_status)
- {
- snd_timer_user_t *tu;
- snd_timer_status_t status;
-
- tu = file->private_data;
- snd_assert(tu->timeri != NULL, return -ENXIO);
- memset(&status, 0, sizeof(status));
- status.tstamp = tu->tstamp;
- status.resolution = snd_timer_resolution(tu->timeri);
- status.lost = tu->timeri->lost;
- status.overrun = tu->overrun;
- spin_lock_irq(&tu->qlock);
- status.queue = tu->qused;
- spin_unlock_irq(&tu->qlock);
- if (copy_to_user(_status, &status, sizeof(status)))
- return -EFAULT;
- return 0;
- }
- static int snd_timer_user_start(struct file *file)
- {
- int err;
- snd_timer_user_t *tu;
-
- tu = file->private_data;
- snd_assert(tu->timeri != NULL, return -ENXIO);
- snd_timer_stop(tu->timeri);
- tu->timeri->lost = 0;
- tu->last_resolution = 0;
- return (err = snd_timer_start(tu->timeri, tu->ticks)) < 0 ? err : 0;
- }
- static int snd_timer_user_stop(struct file *file)
- {
- int err;
- snd_timer_user_t *tu;
-
- tu = file->private_data;
- snd_assert(tu->timeri != NULL, return -ENXIO);
- return (err = snd_timer_stop(tu->timeri)) < 0 ? err : 0;
- }
- static int snd_timer_user_continue(struct file *file)
- {
- int err;
- snd_timer_user_t *tu;
-
- tu = file->private_data;
- snd_assert(tu->timeri != NULL, return -ENXIO);
- tu->timeri->lost = 0;
- return (err = snd_timer_continue(tu->timeri)) < 0 ? err : 0;
- }
- static int snd_timer_user_pause(struct file *file)
- {
- int err;
- snd_timer_user_t *tu;
-
- tu = file->private_data;
- snd_assert(tu->timeri != NULL, return -ENXIO);
- return (err = snd_timer_pause(tu->timeri)) < 0 ? err : 0;
- }
- enum {
- SNDRV_TIMER_IOCTL_START_OLD = _IO('T', 0x20),
- SNDRV_TIMER_IOCTL_STOP_OLD = _IO('T', 0x21),
- SNDRV_TIMER_IOCTL_CONTINUE_OLD = _IO('T', 0x22),
- SNDRV_TIMER_IOCTL_PAUSE_OLD = _IO('T', 0x23),
- };
- static long snd_timer_user_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
- {
- snd_timer_user_t *tu;
- void __user *argp = (void __user *)arg;
- int __user *p = argp;
-
- tu = file->private_data;
- switch (cmd) {
- case SNDRV_TIMER_IOCTL_PVERSION:
- return put_user(SNDRV_TIMER_VERSION, p) ? -EFAULT : 0;
- case SNDRV_TIMER_IOCTL_NEXT_DEVICE:
- return snd_timer_user_next_device(argp);
- case SNDRV_TIMER_IOCTL_TREAD:
- {
- int xarg;
-
- down(&tu->tread_sem);
- if (tu->timeri) { /* too late */
- up(&tu->tread_sem);
- return -EBUSY;
- }
- if (get_user(xarg, p)) {
- up(&tu->tread_sem);
- return -EFAULT;
- }
- tu->tread = xarg ? 1 : 0;
- up(&tu->tread_sem);
- return 0;
- }
- case SNDRV_TIMER_IOCTL_GINFO:
- return snd_timer_user_ginfo(file, argp);
- case SNDRV_TIMER_IOCTL_GPARAMS:
- return snd_timer_user_gparams(file, argp);
- case SNDRV_TIMER_IOCTL_GSTATUS:
- return snd_timer_user_gstatus(file, argp);
- case SNDRV_TIMER_IOCTL_SELECT:
- return snd_timer_user_tselect(file, argp);
- case SNDRV_TIMER_IOCTL_INFO:
- return snd_timer_user_info(file, argp);
- case SNDRV_TIMER_IOCTL_PARAMS:
- return snd_timer_user_params(file, argp);
- case SNDRV_TIMER_IOCTL_STATUS:
- return snd_timer_user_status(file, argp);
- case SNDRV_TIMER_IOCTL_START:
- case SNDRV_TIMER_IOCTL_START_OLD:
- return snd_timer_user_start(file);
- case SNDRV_TIMER_IOCTL_STOP:
- case SNDRV_TIMER_IOCTL_STOP_OLD:
- return snd_timer_user_stop(file);
- case SNDRV_TIMER_IOCTL_CONTINUE:
- case SNDRV_TIMER_IOCTL_CONTINUE_OLD:
- return snd_timer_user_continue(file);
- case SNDRV_TIMER_IOCTL_PAUSE:
- case SNDRV_TIMER_IOCTL_PAUSE_OLD:
- return snd_timer_user_pause(file);
- }
- return -ENOTTY;
- }
- static int snd_timer_user_fasync(int fd, struct file * file, int on)
- {
- snd_timer_user_t *tu;
- int err;
-
- tu = file->private_data;
- err = fasync_helper(fd, file, on, &tu->fasync);
- if (err < 0)
- return err;
- return 0;
- }
- static ssize_t snd_timer_user_read(struct file *file, char __user *buffer, size_t count, loff_t *offset)
- {
- snd_timer_user_t *tu;
- long result = 0, unit;
- int err = 0;
-
- tu = file->private_data;
- unit = tu->tread ? sizeof(snd_timer_tread_t) : sizeof(snd_timer_read_t);
- spin_lock_irq(&tu->qlock);
- while ((long)count - result >= unit) {
- while (!tu->qused) {
- wait_queue_t wait;
- if ((file->f_flags & O_NONBLOCK) != 0 || result > 0) {
- err = -EAGAIN;
- break;
- }
- set_current_state(TASK_INTERRUPTIBLE);
- init_waitqueue_entry(&wait, current);
- add_wait_queue(&tu->qchange_sleep, &wait);
- spin_unlock_irq(&tu->qlock);
- schedule();
- spin_lock_irq(&tu->qlock);
- remove_wait_queue(&tu->qchange_sleep, &wait);
- if (signal_pending(current)) {
- err = -ERESTARTSYS;
- break;
- }
- }
- spin_unlock_irq(&tu->qlock);
- if (err < 0)
- goto _error;
- if (tu->tread) {
- if (copy_to_user(buffer, &tu->tqueue[tu->qhead++], sizeof(snd_timer_tread_t))) {
- err = -EFAULT;
- goto _error;
- }
- } else {
- if (copy_to_user(buffer, &tu->queue[tu->qhead++], sizeof(snd_timer_read_t))) {
- err = -EFAULT;
- goto _error;
- }
- }
- tu->qhead %= tu->queue_size;
- result += unit;
- buffer += unit;
- spin_lock_irq(&tu->qlock);
- tu->qused--;
- }
- spin_unlock_irq(&tu->qlock);
- _error:
- return result > 0 ? result : err;
- }
- static unsigned int snd_timer_user_poll(struct file *file, poll_table * wait)
- {
- unsigned int mask;
- snd_timer_user_t *tu;
- tu = file->private_data;
- poll_wait(file, &tu->qchange_sleep, wait);
-
- mask = 0;
- if (tu->qused)
- mask |= POLLIN | POLLRDNORM;
- return mask;
- }
- #ifdef CONFIG_COMPAT
- #include "timer_compat.c"
- #else
- #define snd_timer_user_ioctl_compat NULL
- #endif
- static struct file_operations snd_timer_f_ops =
- {
- .owner = THIS_MODULE,
- .read = snd_timer_user_read,
- .open = snd_timer_user_open,
- .release = snd_timer_user_release,
- .poll = snd_timer_user_poll,
- .unlocked_ioctl = snd_timer_user_ioctl,
- .compat_ioctl = snd_timer_user_ioctl_compat,
- .fasync = snd_timer_user_fasync,
- };
- static snd_minor_t snd_timer_reg =
- {
- .comment = "timer",
- .f_ops = &snd_timer_f_ops,
- };
- /*
- * ENTRY functions
- */
- static snd_info_entry_t *snd_timer_proc_entry = NULL;
- static int __init alsa_timer_init(void)
- {
- int err;
- snd_info_entry_t *entry;
- #ifdef SNDRV_OSS_INFO_DEV_TIMERS
- snd_oss_info_register(SNDRV_OSS_INFO_DEV_TIMERS, SNDRV_CARDS - 1, "system timer");
- #endif
- if ((entry = snd_info_create_module_entry(THIS_MODULE, "timers", NULL)) != NULL) {
- entry->c.text.read_size = SNDRV_TIMER_DEVICES * 128;
- entry->c.text.read = snd_timer_proc_read;
- if (snd_info_register(entry) < 0) {
- snd_info_free_entry(entry);
- entry = NULL;
- }
- }
- snd_timer_proc_entry = entry;
- if ((err = snd_timer_register_system()) < 0)
- snd_printk(KERN_ERR "unable to register system timer (%i)\n", err);
- if ((err = snd_register_device(SNDRV_DEVICE_TYPE_TIMER,
- NULL, 0, &snd_timer_reg, "timer"))<0)
- snd_printk(KERN_ERR "unable to register timer device (%i)\n", err);
- return 0;
- }
- static void __exit alsa_timer_exit(void)
- {
- struct list_head *p, *n;
- snd_unregister_device(SNDRV_DEVICE_TYPE_TIMER, NULL, 0);
- /* unregister the system timer */
- list_for_each_safe(p, n, &snd_timer_list) {
- snd_timer_t *timer = (snd_timer_t *)list_entry(p, snd_timer_t, device_list);
- snd_timer_unregister(timer);
- }
- if (snd_timer_proc_entry) {
- snd_info_unregister(snd_timer_proc_entry);
- snd_timer_proc_entry = NULL;
- }
- #ifdef SNDRV_OSS_INFO_DEV_TIMERS
- snd_oss_info_unregister(SNDRV_OSS_INFO_DEV_TIMERS, SNDRV_CARDS - 1);
- #endif
- }
- module_init(alsa_timer_init)
- module_exit(alsa_timer_exit)
- EXPORT_SYMBOL(snd_timer_open);
- EXPORT_SYMBOL(snd_timer_close);
- EXPORT_SYMBOL(snd_timer_resolution);
- EXPORT_SYMBOL(snd_timer_start);
- EXPORT_SYMBOL(snd_timer_stop);
- EXPORT_SYMBOL(snd_timer_continue);
- EXPORT_SYMBOL(snd_timer_pause);
- EXPORT_SYMBOL(snd_timer_new);
- EXPORT_SYMBOL(snd_timer_notify);
- EXPORT_SYMBOL(snd_timer_global_new);
- EXPORT_SYMBOL(snd_timer_global_free);
- EXPORT_SYMBOL(snd_timer_global_register);
- EXPORT_SYMBOL(snd_timer_global_unregister);
- EXPORT_SYMBOL(snd_timer_interrupt);
|