| 123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789 |
- // SPDX-License-Identifier: GPL-2.0-or-later
- /*
- * LED state routines for driver control interface
- * Copyright (c) 2021 by Jaroslav Kysela <perex@perex.cz>
- */
- #include <linux/slab.h>
- #include <linux/module.h>
- #include <linux/leds.h>
- #include <sound/core.h>
- #include <sound/control.h>
- MODULE_AUTHOR("Jaroslav Kysela <perex@perex.cz>");
- MODULE_DESCRIPTION("ALSA control interface to LED trigger code.");
- MODULE_LICENSE("GPL");
- #define MAX_LED (((SNDRV_CTL_ELEM_ACCESS_MIC_LED - SNDRV_CTL_ELEM_ACCESS_SPK_LED) \
- >> SNDRV_CTL_ELEM_ACCESS_LED_SHIFT) + 1)
- #define to_led_card_dev(_dev) \
- container_of(_dev, struct snd_ctl_led_card, dev)
- enum snd_ctl_led_mode {
- MODE_FOLLOW_MUTE = 0,
- MODE_FOLLOW_ROUTE,
- MODE_OFF,
- MODE_ON,
- };
- struct snd_ctl_led_card {
- struct device dev;
- int number;
- struct snd_ctl_led *led;
- };
- struct snd_ctl_led {
- struct device dev;
- struct list_head controls;
- const char *name;
- unsigned int group;
- enum led_audio trigger_type;
- enum snd_ctl_led_mode mode;
- struct snd_ctl_led_card *cards[SNDRV_CARDS];
- };
- struct snd_ctl_led_ctl {
- struct list_head list;
- struct snd_card *card;
- unsigned int access;
- struct snd_kcontrol *kctl;
- unsigned int index_offset;
- };
- static DEFINE_MUTEX(snd_ctl_led_mutex);
- static bool snd_ctl_led_card_valid[SNDRV_CARDS];
- static struct led_trigger *snd_ctl_ledtrig_audio[NUM_AUDIO_LEDS];
- static struct snd_ctl_led snd_ctl_leds[MAX_LED] = {
- {
- .name = "speaker",
- .group = (SNDRV_CTL_ELEM_ACCESS_SPK_LED >> SNDRV_CTL_ELEM_ACCESS_LED_SHIFT) - 1,
- .trigger_type = LED_AUDIO_MUTE,
- .mode = MODE_FOLLOW_MUTE,
- },
- {
- .name = "mic",
- .group = (SNDRV_CTL_ELEM_ACCESS_MIC_LED >> SNDRV_CTL_ELEM_ACCESS_LED_SHIFT) - 1,
- .trigger_type = LED_AUDIO_MICMUTE,
- .mode = MODE_FOLLOW_MUTE,
- },
- };
- static void snd_ctl_led_sysfs_add(struct snd_card *card);
- static void snd_ctl_led_sysfs_remove(struct snd_card *card);
- #define UPDATE_ROUTE(route, cb) \
- do { \
- int route2 = (cb); \
- if (route2 >= 0) \
- route = route < 0 ? route2 : (route | route2); \
- } while (0)
- static inline unsigned int access_to_group(unsigned int access)
- {
- return ((access & SNDRV_CTL_ELEM_ACCESS_LED_MASK) >>
- SNDRV_CTL_ELEM_ACCESS_LED_SHIFT) - 1;
- }
- static inline unsigned int group_to_access(unsigned int group)
- {
- return (group + 1) << SNDRV_CTL_ELEM_ACCESS_LED_SHIFT;
- }
- static struct snd_ctl_led *snd_ctl_led_get_by_access(unsigned int access)
- {
- unsigned int group = access_to_group(access);
- if (group >= MAX_LED)
- return NULL;
- return &snd_ctl_leds[group];
- }
- /*
- * A note for callers:
- * The two static variables info and value are protected using snd_ctl_led_mutex.
- */
- static int snd_ctl_led_get(struct snd_ctl_led_ctl *lctl)
- {
- static struct snd_ctl_elem_info info;
- static struct snd_ctl_elem_value value;
- struct snd_kcontrol *kctl = lctl->kctl;
- unsigned int i;
- int result;
- memset(&info, 0, sizeof(info));
- info.id = kctl->id;
- info.id.index += lctl->index_offset;
- info.id.numid += lctl->index_offset;
- result = kctl->info(kctl, &info);
- if (result < 0)
- return -1;
- memset(&value, 0, sizeof(value));
- value.id = info.id;
- result = kctl->get(kctl, &value);
- if (result < 0)
- return -1;
- if (info.type == SNDRV_CTL_ELEM_TYPE_BOOLEAN ||
- info.type == SNDRV_CTL_ELEM_TYPE_INTEGER) {
- for (i = 0; i < info.count; i++)
- if (value.value.integer.value[i] != info.value.integer.min)
- return 1;
- } else if (info.type == SNDRV_CTL_ELEM_TYPE_INTEGER64) {
- for (i = 0; i < info.count; i++)
- if (value.value.integer64.value[i] != info.value.integer64.min)
- return 1;
- }
- return 0;
- }
- static void snd_ctl_led_set_state(struct snd_card *card, unsigned int access,
- struct snd_kcontrol *kctl, unsigned int ioff)
- {
- struct snd_ctl_led *led;
- struct snd_ctl_led_ctl *lctl;
- int route;
- bool found;
- led = snd_ctl_led_get_by_access(access);
- if (!led)
- return;
- route = -1;
- found = false;
- scoped_guard(mutex, &snd_ctl_led_mutex) {
- /* the card may not be registered (active) at this point */
- if (card && !snd_ctl_led_card_valid[card->number])
- return;
- list_for_each_entry(lctl, &led->controls, list) {
- if (lctl->kctl == kctl && lctl->index_offset == ioff)
- found = true;
- UPDATE_ROUTE(route, snd_ctl_led_get(lctl));
- }
- if (!found && kctl && card) {
- lctl = kzalloc(sizeof(*lctl), GFP_KERNEL);
- if (lctl) {
- lctl->card = card;
- lctl->access = access;
- lctl->kctl = kctl;
- lctl->index_offset = ioff;
- list_add(&lctl->list, &led->controls);
- UPDATE_ROUTE(route, snd_ctl_led_get(lctl));
- }
- }
- }
- switch (led->mode) {
- case MODE_OFF: route = 1; break;
- case MODE_ON: route = 0; break;
- case MODE_FOLLOW_ROUTE: if (route >= 0) route ^= 1; break;
- case MODE_FOLLOW_MUTE: /* noop */ break;
- }
- if (route >= 0) {
- struct led_trigger *trig = snd_ctl_ledtrig_audio[led->trigger_type];
- led_trigger_event(trig, route ? LED_OFF : LED_ON);
- }
- }
- static struct snd_ctl_led_ctl *snd_ctl_led_find(struct snd_kcontrol *kctl, unsigned int ioff)
- {
- struct list_head *controls;
- struct snd_ctl_led_ctl *lctl;
- unsigned int group;
- for (group = 0; group < MAX_LED; group++) {
- controls = &snd_ctl_leds[group].controls;
- list_for_each_entry(lctl, controls, list)
- if (lctl->kctl == kctl && lctl->index_offset == ioff)
- return lctl;
- }
- return NULL;
- }
- static unsigned int snd_ctl_led_remove(struct snd_kcontrol *kctl, unsigned int ioff,
- unsigned int access)
- {
- struct snd_ctl_led_ctl *lctl;
- unsigned int ret = 0;
- guard(mutex)(&snd_ctl_led_mutex);
- lctl = snd_ctl_led_find(kctl, ioff);
- if (lctl && (access == 0 || access != lctl->access)) {
- ret = lctl->access;
- list_del(&lctl->list);
- kfree(lctl);
- }
- return ret;
- }
- static void snd_ctl_led_notify(struct snd_card *card, unsigned int mask,
- struct snd_kcontrol *kctl, unsigned int ioff)
- {
- struct snd_kcontrol_volatile *vd;
- unsigned int access, access2;
- if (mask == SNDRV_CTL_EVENT_MASK_REMOVE) {
- access = snd_ctl_led_remove(kctl, ioff, 0);
- if (access)
- snd_ctl_led_set_state(card, access, NULL, 0);
- } else if (mask & SNDRV_CTL_EVENT_MASK_INFO) {
- vd = &kctl->vd[ioff];
- access = vd->access & SNDRV_CTL_ELEM_ACCESS_LED_MASK;
- access2 = snd_ctl_led_remove(kctl, ioff, access);
- if (access2)
- snd_ctl_led_set_state(card, access2, NULL, 0);
- if (access)
- snd_ctl_led_set_state(card, access, kctl, ioff);
- } else if ((mask & (SNDRV_CTL_EVENT_MASK_ADD |
- SNDRV_CTL_EVENT_MASK_VALUE)) != 0) {
- vd = &kctl->vd[ioff];
- access = vd->access & SNDRV_CTL_ELEM_ACCESS_LED_MASK;
- if (access)
- snd_ctl_led_set_state(card, access, kctl, ioff);
- }
- }
- DEFINE_FREE(snd_card_unref, struct snd_card *, if (_T) snd_card_unref(_T))
- static int snd_ctl_led_set_id(int card_number, struct snd_ctl_elem_id *id,
- unsigned int group, bool set)
- {
- struct snd_card *card __free(snd_card_unref) = NULL;
- struct snd_kcontrol *kctl;
- struct snd_kcontrol_volatile *vd;
- unsigned int ioff, access, new_access;
- card = snd_card_ref(card_number);
- if (!card)
- return -ENXIO;
- guard(rwsem_write)(&card->controls_rwsem);
- kctl = snd_ctl_find_id(card, id);
- if (!kctl)
- return -ENOENT;
- ioff = snd_ctl_get_ioff(kctl, id);
- vd = &kctl->vd[ioff];
- access = vd->access & SNDRV_CTL_ELEM_ACCESS_LED_MASK;
- if (access != 0 && access != group_to_access(group))
- return -EXDEV;
- new_access = vd->access & ~SNDRV_CTL_ELEM_ACCESS_LED_MASK;
- if (set)
- new_access |= group_to_access(group);
- if (new_access != vd->access) {
- vd->access = new_access;
- snd_ctl_led_notify(card, SNDRV_CTL_EVENT_MASK_INFO, kctl, ioff);
- }
- return 0;
- }
- static void snd_ctl_led_refresh(void)
- {
- unsigned int group;
- for (group = 0; group < MAX_LED; group++)
- snd_ctl_led_set_state(NULL, group_to_access(group), NULL, 0);
- }
- static void snd_ctl_led_ctl_destroy(struct snd_ctl_led_ctl *lctl)
- {
- list_del(&lctl->list);
- kfree(lctl);
- }
- static void snd_ctl_led_clean(struct snd_card *card)
- {
- unsigned int group;
- struct snd_ctl_led_ctl *lctl, *_lctl;
- struct snd_ctl_led *led;
- for (group = 0; group < MAX_LED; group++) {
- led = &snd_ctl_leds[group];
- list_for_each_entry_safe(lctl, _lctl, &led->controls, list)
- if (!card || lctl->card == card)
- snd_ctl_led_ctl_destroy(lctl);
- }
- }
- static int snd_ctl_led_reset(int card_number, unsigned int group)
- {
- struct snd_card *card __free(snd_card_unref) = NULL;
- struct snd_ctl_led_ctl *lctl, *_lctl;
- struct snd_ctl_led *led;
- struct snd_kcontrol_volatile *vd;
- bool change = false;
- card = snd_card_ref(card_number);
- if (!card)
- return -ENXIO;
- scoped_guard(mutex, &snd_ctl_led_mutex) {
- if (!snd_ctl_led_card_valid[card_number])
- return -ENXIO;
- led = &snd_ctl_leds[group];
- list_for_each_entry_safe(lctl, _lctl, &led->controls, list)
- if (lctl->card == card) {
- vd = &lctl->kctl->vd[lctl->index_offset];
- vd->access &= ~group_to_access(group);
- snd_ctl_led_ctl_destroy(lctl);
- change = true;
- }
- }
- if (change)
- snd_ctl_led_set_state(NULL, group_to_access(group), NULL, 0);
- return 0;
- }
- static void snd_ctl_led_register(struct snd_card *card)
- {
- struct snd_kcontrol *kctl;
- unsigned int ioff;
- if (snd_BUG_ON(card->number < 0 ||
- card->number >= ARRAY_SIZE(snd_ctl_led_card_valid)))
- return;
- scoped_guard(mutex, &snd_ctl_led_mutex)
- snd_ctl_led_card_valid[card->number] = true;
- /* the register callback is already called with held card->controls_rwsem */
- list_for_each_entry(kctl, &card->controls, list)
- for (ioff = 0; ioff < kctl->count; ioff++)
- snd_ctl_led_notify(card, SNDRV_CTL_EVENT_MASK_VALUE, kctl, ioff);
- snd_ctl_led_refresh();
- snd_ctl_led_sysfs_add(card);
- }
- static void snd_ctl_led_disconnect(struct snd_card *card)
- {
- snd_ctl_led_sysfs_remove(card);
- scoped_guard(mutex, &snd_ctl_led_mutex) {
- snd_ctl_led_card_valid[card->number] = false;
- snd_ctl_led_clean(card);
- }
- snd_ctl_led_refresh();
- }
- static void snd_ctl_led_card_release(struct device *dev)
- {
- struct snd_ctl_led_card *led_card = to_led_card_dev(dev);
- kfree(led_card);
- }
- static void snd_ctl_led_release(struct device *dev)
- {
- }
- static void snd_ctl_led_dev_release(struct device *dev)
- {
- }
- /*
- * sysfs
- */
- static ssize_t mode_show(struct device *dev,
- struct device_attribute *attr, char *buf)
- {
- struct snd_ctl_led *led = container_of(dev, struct snd_ctl_led, dev);
- const char *str = NULL;
- switch (led->mode) {
- case MODE_FOLLOW_MUTE: str = "follow-mute"; break;
- case MODE_FOLLOW_ROUTE: str = "follow-route"; break;
- case MODE_ON: str = "on"; break;
- case MODE_OFF: str = "off"; break;
- }
- return sysfs_emit(buf, "%s\n", str);
- }
- static ssize_t mode_store(struct device *dev,
- struct device_attribute *attr,
- const char *buf, size_t count)
- {
- struct snd_ctl_led *led = container_of(dev, struct snd_ctl_led, dev);
- char _buf[16];
- size_t l = min(count, sizeof(_buf) - 1);
- enum snd_ctl_led_mode mode;
- memcpy(_buf, buf, l);
- _buf[l] = '\0';
- if (strstr(_buf, "mute"))
- mode = MODE_FOLLOW_MUTE;
- else if (strstr(_buf, "route"))
- mode = MODE_FOLLOW_ROUTE;
- else if (strncmp(_buf, "off", 3) == 0 || strncmp(_buf, "0", 1) == 0)
- mode = MODE_OFF;
- else if (strncmp(_buf, "on", 2) == 0 || strncmp(_buf, "1", 1) == 0)
- mode = MODE_ON;
- else
- return count;
- scoped_guard(mutex, &snd_ctl_led_mutex)
- led->mode = mode;
- snd_ctl_led_set_state(NULL, group_to_access(led->group), NULL, 0);
- return count;
- }
- static ssize_t brightness_show(struct device *dev,
- struct device_attribute *attr, char *buf)
- {
- struct snd_ctl_led *led = container_of(dev, struct snd_ctl_led, dev);
- struct led_trigger *trig = snd_ctl_ledtrig_audio[led->trigger_type];
- return sysfs_emit(buf, "%u\n", led_trigger_get_brightness(trig));
- }
- static DEVICE_ATTR_RW(mode);
- static DEVICE_ATTR_RO(brightness);
- static struct attribute *snd_ctl_led_dev_attrs[] = {
- &dev_attr_mode.attr,
- &dev_attr_brightness.attr,
- NULL,
- };
- static const struct attribute_group snd_ctl_led_dev_attr_group = {
- .attrs = snd_ctl_led_dev_attrs,
- };
- static const struct attribute_group *snd_ctl_led_dev_attr_groups[] = {
- &snd_ctl_led_dev_attr_group,
- NULL,
- };
- static char *find_eos(char *s)
- {
- while (*s && *s != ',')
- s++;
- if (*s)
- s++;
- return s;
- }
- static char *parse_uint(char *s, unsigned int *val)
- {
- unsigned long long res;
- if (kstrtoull(s, 10, &res))
- res = 0;
- *val = res;
- return find_eos(s);
- }
- static char *parse_string(char *s, char *val, size_t val_size)
- {
- if (*s == '"' || *s == '\'') {
- char c = *s;
- s++;
- while (*s && *s != c) {
- if (val_size > 1) {
- *val++ = *s;
- val_size--;
- }
- s++;
- }
- } else {
- while (*s && *s != ',') {
- if (val_size > 1) {
- *val++ = *s;
- val_size--;
- }
- s++;
- }
- }
- *val = '\0';
- if (*s)
- s++;
- return s;
- }
- static char *parse_iface(char *s, snd_ctl_elem_iface_t *val)
- {
- if (!strncasecmp(s, "card", 4))
- *val = SNDRV_CTL_ELEM_IFACE_CARD;
- else if (!strncasecmp(s, "mixer", 5))
- *val = SNDRV_CTL_ELEM_IFACE_MIXER;
- return find_eos(s);
- }
- /*
- * These types of input strings are accepted:
- *
- * unsigned integer - numid (equivaled to numid=UINT)
- * string - basic mixer name (equivalent to iface=MIXER,name=STR)
- * numid=UINT
- * [iface=MIXER,][device=UINT,][subdevice=UINT,]name=STR[,index=UINT]
- */
- static ssize_t set_led_id(struct snd_ctl_led_card *led_card, const char *buf, size_t count,
- bool attach)
- {
- char buf2[256], *s, *os;
- struct snd_ctl_elem_id id;
- int err;
- if (strscpy(buf2, buf, sizeof(buf2)) < 0)
- return -E2BIG;
- memset(&id, 0, sizeof(id));
- id.iface = SNDRV_CTL_ELEM_IFACE_MIXER;
- s = buf2;
- while (*s) {
- os = s;
- if (!strncasecmp(s, "numid=", 6)) {
- s = parse_uint(s + 6, &id.numid);
- } else if (!strncasecmp(s, "iface=", 6)) {
- s = parse_iface(s + 6, &id.iface);
- } else if (!strncasecmp(s, "device=", 7)) {
- s = parse_uint(s + 7, &id.device);
- } else if (!strncasecmp(s, "subdevice=", 10)) {
- s = parse_uint(s + 10, &id.subdevice);
- } else if (!strncasecmp(s, "name=", 5)) {
- s = parse_string(s + 5, id.name, sizeof(id.name));
- } else if (!strncasecmp(s, "index=", 6)) {
- s = parse_uint(s + 6, &id.index);
- } else if (s == buf2) {
- while (*s) {
- if (*s < '0' || *s > '9')
- break;
- s++;
- }
- if (*s == '\0')
- parse_uint(buf2, &id.numid);
- else {
- for (; *s >= ' '; s++);
- *s = '\0';
- strscpy(id.name, buf2, sizeof(id.name));
- }
- break;
- }
- if (*s == ',')
- s++;
- if (s == os)
- break;
- }
- err = snd_ctl_led_set_id(led_card->number, &id, led_card->led->group, attach);
- if (err < 0)
- return err;
- return count;
- }
- static ssize_t attach_store(struct device *dev,
- struct device_attribute *attr,
- const char *buf, size_t count)
- {
- struct snd_ctl_led_card *led_card = container_of(dev, struct snd_ctl_led_card, dev);
- return set_led_id(led_card, buf, count, true);
- }
- static ssize_t detach_store(struct device *dev,
- struct device_attribute *attr,
- const char *buf, size_t count)
- {
- struct snd_ctl_led_card *led_card = container_of(dev, struct snd_ctl_led_card, dev);
- return set_led_id(led_card, buf, count, false);
- }
- static ssize_t reset_store(struct device *dev,
- struct device_attribute *attr,
- const char *buf, size_t count)
- {
- struct snd_ctl_led_card *led_card = container_of(dev, struct snd_ctl_led_card, dev);
- int err;
- if (count > 0 && buf[0] == '1') {
- err = snd_ctl_led_reset(led_card->number, led_card->led->group);
- if (err < 0)
- return err;
- }
- return count;
- }
- static ssize_t list_show(struct device *dev,
- struct device_attribute *attr, char *buf)
- {
- struct snd_ctl_led_card *led_card = container_of(dev, struct snd_ctl_led_card, dev);
- struct snd_card *card __free(snd_card_unref) = NULL;
- struct snd_ctl_led_ctl *lctl;
- size_t l = 0;
- card = snd_card_ref(led_card->number);
- if (!card)
- return -ENXIO;
- guard(rwsem_read)(&card->controls_rwsem);
- guard(mutex)(&snd_ctl_led_mutex);
- if (snd_ctl_led_card_valid[led_card->number]) {
- list_for_each_entry(lctl, &led_card->led->controls, list) {
- if (lctl->card != card)
- continue;
- if (l)
- l += sysfs_emit_at(buf, l, " ");
- l += sysfs_emit_at(buf, l, "%u",
- lctl->kctl->id.numid + lctl->index_offset);
- }
- }
- return l;
- }
- static DEVICE_ATTR_WO(attach);
- static DEVICE_ATTR_WO(detach);
- static DEVICE_ATTR_WO(reset);
- static DEVICE_ATTR_RO(list);
- static struct attribute *snd_ctl_led_card_attrs[] = {
- &dev_attr_attach.attr,
- &dev_attr_detach.attr,
- &dev_attr_reset.attr,
- &dev_attr_list.attr,
- NULL,
- };
- static const struct attribute_group snd_ctl_led_card_attr_group = {
- .attrs = snd_ctl_led_card_attrs,
- };
- static const struct attribute_group *snd_ctl_led_card_attr_groups[] = {
- &snd_ctl_led_card_attr_group,
- NULL,
- };
- static struct device snd_ctl_led_dev;
- static void snd_ctl_led_sysfs_add(struct snd_card *card)
- {
- unsigned int group;
- struct snd_ctl_led_card *led_card;
- struct snd_ctl_led *led;
- char link_name[32];
- for (group = 0; group < MAX_LED; group++) {
- led = &snd_ctl_leds[group];
- led_card = kzalloc(sizeof(*led_card), GFP_KERNEL);
- if (!led_card)
- goto cerr2;
- led_card->number = card->number;
- led_card->led = led;
- device_initialize(&led_card->dev);
- led_card->dev.release = snd_ctl_led_card_release;
- if (dev_set_name(&led_card->dev, "card%d", card->number) < 0)
- goto cerr;
- led_card->dev.parent = &led->dev;
- led_card->dev.groups = snd_ctl_led_card_attr_groups;
- if (device_add(&led_card->dev))
- goto cerr;
- led->cards[card->number] = led_card;
- snprintf(link_name, sizeof(link_name), "led-%s", led->name);
- if (sysfs_create_link(&card->ctl_dev->kobj, &led_card->dev.kobj,
- link_name))
- dev_err(card->dev,
- "%s: can't create symlink to controlC%i device\n",
- __func__, card->number);
- if (sysfs_create_link(&led_card->dev.kobj, &card->card_dev.kobj,
- "card"))
- dev_err(card->dev,
- "%s: can't create symlink to card%i\n",
- __func__, card->number);
- continue;
- cerr:
- put_device(&led_card->dev);
- cerr2:
- dev_err(card->dev, "snd_ctl_led: unable to add card%d", card->number);
- }
- }
- static void snd_ctl_led_sysfs_remove(struct snd_card *card)
- {
- unsigned int group;
- struct snd_ctl_led_card *led_card;
- struct snd_ctl_led *led;
- char link_name[32];
- for (group = 0; group < MAX_LED; group++) {
- led = &snd_ctl_leds[group];
- led_card = led->cards[card->number];
- if (!led_card)
- continue;
- snprintf(link_name, sizeof(link_name), "led-%s", led->name);
- sysfs_remove_link(&card->ctl_dev->kobj, link_name);
- sysfs_remove_link(&led_card->dev.kobj, "card");
- device_unregister(&led_card->dev);
- led->cards[card->number] = NULL;
- }
- }
- /*
- * Control layer registration
- */
- static struct snd_ctl_layer_ops snd_ctl_led_lops = {
- .module_name = SND_CTL_LAYER_MODULE_LED,
- .lregister = snd_ctl_led_register,
- .ldisconnect = snd_ctl_led_disconnect,
- .lnotify = snd_ctl_led_notify,
- };
- static int __init snd_ctl_led_init(void)
- {
- struct snd_ctl_led *led;
- unsigned int group;
- led_trigger_register_simple("audio-mute", &snd_ctl_ledtrig_audio[LED_AUDIO_MUTE]);
- led_trigger_register_simple("audio-micmute", &snd_ctl_ledtrig_audio[LED_AUDIO_MICMUTE]);
- device_initialize(&snd_ctl_led_dev);
- snd_ctl_led_dev.class = &sound_class;
- snd_ctl_led_dev.release = snd_ctl_led_dev_release;
- dev_set_name(&snd_ctl_led_dev, "ctl-led");
- if (device_add(&snd_ctl_led_dev)) {
- put_device(&snd_ctl_led_dev);
- return -ENOMEM;
- }
- for (group = 0; group < MAX_LED; group++) {
- led = &snd_ctl_leds[group];
- INIT_LIST_HEAD(&led->controls);
- device_initialize(&led->dev);
- led->dev.parent = &snd_ctl_led_dev;
- led->dev.release = snd_ctl_led_release;
- led->dev.groups = snd_ctl_led_dev_attr_groups;
- dev_set_name(&led->dev, led->name);
- if (device_add(&led->dev)) {
- put_device(&led->dev);
- for (; group > 0; group--) {
- led = &snd_ctl_leds[group - 1];
- device_unregister(&led->dev);
- }
- device_unregister(&snd_ctl_led_dev);
- return -ENOMEM;
- }
- }
- snd_ctl_register_layer(&snd_ctl_led_lops);
- return 0;
- }
- static void __exit snd_ctl_led_exit(void)
- {
- struct snd_ctl_led *led;
- struct snd_card *card;
- unsigned int group, card_number;
- snd_ctl_disconnect_layer(&snd_ctl_led_lops);
- for (card_number = 0; card_number < SNDRV_CARDS; card_number++) {
- if (!snd_ctl_led_card_valid[card_number])
- continue;
- card = snd_card_ref(card_number);
- if (card) {
- snd_ctl_led_sysfs_remove(card);
- snd_card_unref(card);
- }
- }
- for (group = 0; group < MAX_LED; group++) {
- led = &snd_ctl_leds[group];
- device_unregister(&led->dev);
- }
- device_unregister(&snd_ctl_led_dev);
- snd_ctl_led_clean(NULL);
- led_trigger_unregister_simple(snd_ctl_ledtrig_audio[LED_AUDIO_MUTE]);
- led_trigger_unregister_simple(snd_ctl_ledtrig_audio[LED_AUDIO_MICMUTE]);
- }
- module_init(snd_ctl_led_init)
- module_exit(snd_ctl_led_exit)
- MODULE_ALIAS("ledtrig:audio-mute");
- MODULE_ALIAS("ledtrig:audio-micmute");
|