[linux-2.6-block.git] / sound / pci / hda / thinkpad_helper.c

/* Helper functions for Thinkpad LED control;
 * to be included from codec driver
 */

#if IS_ENABLED(CONFIG_THINKPAD_ACPI)

#include <linux/acpi.h>
#include <linux/thinkpad_acpi.h>

static int (*led_set_func)(int, bool);
static void (*old_vmaster_hook)(void *, int);

static bool is_thinkpad(struct hda_codec *codec)
{
	return (codec->core.subsystem_id >> 16 == 0x17aa) &&
	       (acpi_dev_found("LEN0068") || acpi_dev_found("IBM0068"));
}

static void update_tpacpi_mute_led(void *private_data, int enabled)
{
	if (old_vmaster_hook)
		old_vmaster_hook(private_data, enabled);

	if (led_set_func)
		led_set_func(TPACPI_LED_MUTE, !enabled);
}

static void update_tpacpi_micmute_led(struct hda_codec *codec,
				      struct snd_kcontrol *kcontrol,
				      struct snd_ctl_elem_value *ucontrol)
{
	if (!ucontrol || !led_set_func)
		return;
	if (strcmp("Capture Switch", ucontrol->id.name) == 0 && ucontrol->id.index == 0) {
		/* TODO: How do I verify if it's a mono or stereo here? */
		bool val = ucontrol->value.integer.value[0] || ucontrol->value.integer.value[1];
		led_set_func(TPACPI_LED_MICMUTE, !val);
	}
}

static void hda_fixup_thinkpad_acpi(struct hda_codec *codec,
				    const struct hda_fixup *fix, int action)
{
	struct hda_gen_spec *spec = codec->spec;
	bool removefunc = false;

	if (action == HDA_FIXUP_ACT_PROBE) {
		if (!is_thinkpad(codec))
			return;
		if (!led_set_func)
			led_set_func = symbol_request(tpacpi_led_set);
		if (!led_set_func) {
			codec_warn(codec,
				   "Failed to find thinkpad-acpi symbol tpacpi_led_set\n");
			return;
		}

		removefunc = true;
		if (led_set_func(TPACPI_LED_MUTE, false) >= 0) {
			old_vmaster_hook = spec->vmaster_mute.hook;
			spec->vmaster_mute.hook = update_tpacpi_mute_led;
			removefunc = false;
		}
		if (led_set_func(TPACPI_LED_MICMUTE, false) >= 0) {
			if (spec->num_adc_nids > 1)
				codec_dbg(codec,
					  "Skipping micmute LED control due to several ADCs");
			else {
				spec->cap_sync_hook = update_tpacpi_micmute_led;
				removefunc = false;
			}
		}
	}

	if (led_set_func && (action == HDA_FIXUP_ACT_FREE || removefunc)) {
		symbol_put(tpacpi_led_set);
		led_set_func = NULL;
		old_vmaster_hook = NULL;
	}
}

#else /* CONFIG_THINKPAD_ACPI */

static void hda_fixup_thinkpad_acpi(struct hda_codec *codec,
				    const struct hda_fixup *fix, int action)
{
}

#endif /* CONFIG_THINKPAD_ACPI */
Commit	Line	Data
b317b032 TI	1	/* Helper functions for Thinkpad LED control;
	2	* to be included from codec driver
	3	*/
	4
	5	#if IS_ENABLED(CONFIG_THINKPAD_ACPI)
	6
	7	#include <linux/acpi.h>
	8	#include <linux/thinkpad_acpi.h>
	9
	10	static int (*led_set_func)(int, bool);
cf67c8e7	11	static void (old_vmaster_hook)(void , int);
b317b032	12
b317b032 TI	13	static bool is_thinkpad(struct hda_codec *codec)
b317b032 TI	14	{
c3a90058	15	return (codec->core.subsystem_id >> 16 == 0x17aa) &&
c68ae33e	16	(acpi_dev_found("LEN0068") \|\| acpi_dev_found("IBM0068"));
b317b032 TI	17	}
	18
	19	static void update_tpacpi_mute_led(void *private_data, int enabled)
	20	{
cf67c8e7 TI	21	if (old_vmaster_hook)
cf67c8e7 TI	22	old_vmaster_hook(private_data, enabled);
b317b032 TI	23
	24	if (led_set_func)
	25	led_set_func(TPACPI_LED_MUTE, !enabled);
	26	}
	27
	28	static void update_tpacpi_micmute_led(struct hda_codec *codec,
7fe30711	29	struct snd_kcontrol *kcontrol,
b317b032 TI	30	struct snd_ctl_elem_value *ucontrol)
	31	{
	32	if (!ucontrol \|\| !led_set_func)
	33	return;
	34	if (strcmp("Capture Switch", ucontrol->id.name) == 0 && ucontrol->id.index == 0) {
	35	/* TODO: How do I verify if it's a mono or stereo here? */
	36	bool val = ucontrol->value.integer.value[0] \|\| ucontrol->value.integer.value[1];
	37	led_set_func(TPACPI_LED_MICMUTE, !val);
	38	}
	39	}
	40
	41	static void hda_fixup_thinkpad_acpi(struct hda_codec *codec,
	42	const struct hda_fixup *fix, int action)
	43	{
	44	struct hda_gen_spec *spec = codec->spec;
	45	bool removefunc = false;
	46
	47	if (action == HDA_FIXUP_ACT_PROBE) {
	48	if (!is_thinkpad(codec))
	49	return;
	50	if (!led_set_func)
	51	led_set_func = symbol_request(tpacpi_led_set);
	52	if (!led_set_func) {
4e76a883 TI	53	codec_warn(codec,
4e76a883 TI	54	"Failed to find thinkpad-acpi symbol tpacpi_led_set\n");
b317b032 TI	55	return;
	56	}
	57
	58	removefunc = true;
	59	if (led_set_func(TPACPI_LED_MUTE, false) >= 0) {
cf67c8e7	60	old_vmaster_hook = spec->vmaster_mute.hook;
b317b032 TI	61	spec->vmaster_mute.hook = update_tpacpi_mute_led;
	62	removefunc = false;
	63	}
	64	if (led_set_func(TPACPI_LED_MICMUTE, false) >= 0) {
	65	if (spec->num_adc_nids > 1)
4e76a883 TI	66	codec_dbg(codec,
4e76a883 TI	67	"Skipping micmute LED control due to several ADCs");
b317b032 TI	68	else {
	69	spec->cap_sync_hook = update_tpacpi_micmute_led;
	70	removefunc = false;
	71	}
	72	}
	73	}
	74
	75	if (led_set_func && (action == HDA_FIXUP_ACT_FREE \|\| removefunc)) {
	76	symbol_put(tpacpi_led_set);
	77	led_set_func = NULL;
cf67c8e7	78	old_vmaster_hook = NULL;
b317b032 TI	79	}
	80	}
	81
	82	#else /* CONFIG_THINKPAD_ACPI */
	83
	84	static void hda_fixup_thinkpad_acpi(struct hda_codec *codec,
	85	const struct hda_fixup *fix, int action)
	86	{
	87	}
	88
	89	#endif /* CONFIG_THINKPAD_ACPI */