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

// SPDX-License-Identifier: GPL-2.0
/* 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("LEN0268") ||
		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(struct hda_codec *codec)
{
	struct hda_gen_spec *spec = codec->spec;

	led_set_func(TPACPI_LED_MICMUTE, spec->micmute_led.led_value);
}

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 &&
		    snd_hda_gen_add_micmute_led(codec,
						update_tpacpi_micmute) > 0)
			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
b2441318	1	// SPDX-License-Identifier: GPL-2.0
b317b032 TI	2	/* Helper functions for Thinkpad LED control;
	3	* to be included from codec driver
	4	*/
	5
	6	#if IS_ENABLED(CONFIG_THINKPAD_ACPI)
	7
	8	#include <linux/acpi.h>
	9	#include <linux/thinkpad_acpi.h>
	10
	11	static int (*led_set_func)(int, bool);
cf67c8e7	12	static void (old_vmaster_hook)(void , int);
b317b032	13
b317b032 TI	14	static bool is_thinkpad(struct hda_codec *codec)
b317b032 TI	15	{
c3a90058	16	return (codec->core.subsystem_id >> 16 == 0x17aa) &&
2ecb704a HW	17	(acpi_dev_found("LEN0068") \|\| acpi_dev_found("LEN0268") \|\|
2ecb704a HW	18	acpi_dev_found("IBM0068"));
b317b032 TI	19	}
	20
	21	static void update_tpacpi_mute_led(void *private_data, int enabled)
	22	{
cf67c8e7 TI	23	if (old_vmaster_hook)
cf67c8e7 TI	24	old_vmaster_hook(private_data, enabled);
b317b032 TI	25
	26	if (led_set_func)
	27	led_set_func(TPACPI_LED_MUTE, !enabled);
	28	}
	29
69b2c6d7	30	static void update_tpacpi_micmute(struct hda_codec *codec)
b317b032	31	{
69b2c6d7 TI	32	struct hda_gen_spec *spec = codec->spec;
	33
	34	led_set_func(TPACPI_LED_MICMUTE, spec->micmute_led.led_value);
b317b032 TI	35	}
	36
	37	static void hda_fixup_thinkpad_acpi(struct hda_codec *codec,
	38	const struct hda_fixup *fix, int action)
	39	{
	40	struct hda_gen_spec *spec = codec->spec;
	41	bool removefunc = false;
	42
	43	if (action == HDA_FIXUP_ACT_PROBE) {
	44	if (!is_thinkpad(codec))
	45	return;
	46	if (!led_set_func)
	47	led_set_func = symbol_request(tpacpi_led_set);
	48	if (!led_set_func) {
4e76a883 TI	49	codec_warn(codec,
4e76a883 TI	50	"Failed to find thinkpad-acpi symbol tpacpi_led_set\n");
b317b032 TI	51	return;
	52	}
	53
	54	removefunc = true;
	55	if (led_set_func(TPACPI_LED_MUTE, false) >= 0) {
cf67c8e7	56	old_vmaster_hook = spec->vmaster_mute.hook;
b317b032 TI	57	spec->vmaster_mute.hook = update_tpacpi_mute_led;
	58	removefunc = false;
	59	}
69b2c6d7 TI	60	if (led_set_func(TPACPI_LED_MICMUTE, false) >= 0 &&
	61	snd_hda_gen_add_micmute_led(codec,
	62	update_tpacpi_micmute) > 0)
	63	removefunc = false;
b317b032 TI	64	}
	65
	66	if (led_set_func && (action == HDA_FIXUP_ACT_FREE \|\| removefunc)) {
	67	symbol_put(tpacpi_led_set);
	68	led_set_func = NULL;
cf67c8e7	69	old_vmaster_hook = NULL;
b317b032 TI	70	}
	71	}
	72
	73	#else /* CONFIG_THINKPAD_ACPI */
	74
	75	static void hda_fixup_thinkpad_acpi(struct hda_codec *codec,
	76	const struct hda_fixup *fix, int action)
	77	{
	78	}
	79
	80	#endif /* CONFIG_THINKPAD_ACPI */