[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 acpi_status acpi_check_cb(acpi_handle handle, u32 lvl, void *context,
				 void **rv)
{
	bool *found = context;
	*found = true;
	return AE_OK;
}

static bool is_thinkpad(struct hda_codec *codec)
{
	bool found = false;
	if (codec->core.subsystem_id >> 16 != 0x17aa)
		return false;
	if (ACPI_SUCCESS(acpi_get_devices("LEN0068", acpi_check_cb, &found, NULL)) && found)
		return true;
	found = false;
	return ACPI_SUCCESS(acpi_get_devices("IBM0068", acpi_check_cb, &found, NULL)) && found;
}

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;
			spec->vmaster_mute_enum = 1;
			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 TI	12
	13	static acpi_status acpi_check_cb(acpi_handle handle, u32 lvl, void *context,
	14	void **rv)
	15	{
	16	bool *found = context;
	17	*found = true;
	18	return AE_OK;
	19	}
	20
	21	static bool is_thinkpad(struct hda_codec *codec)
	22	{
	23	bool found = false;
7639a06c	24	if (codec->core.subsystem_id >> 16 != 0x17aa)
b317b032 TI	25	return false;
	26	if (ACPI_SUCCESS(acpi_get_devices("LEN0068", acpi_check_cb, &found, NULL)) && found)
	27	return true;
	28	found = false;
	29	return ACPI_SUCCESS(acpi_get_devices("IBM0068", acpi_check_cb, &found, NULL)) && found;
	30	}
	31
	32	static void update_tpacpi_mute_led(void *private_data, int enabled)
	33	{
cf67c8e7 TI	34	if (old_vmaster_hook)
cf67c8e7 TI	35	old_vmaster_hook(private_data, enabled);
b317b032 TI	36
	37	if (led_set_func)
	38	led_set_func(TPACPI_LED_MUTE, !enabled);
	39	}
	40
	41	static void update_tpacpi_micmute_led(struct hda_codec *codec,
7fe30711	42	struct snd_kcontrol *kcontrol,
b317b032 TI	43	struct snd_ctl_elem_value *ucontrol)
	44	{
	45	if (!ucontrol \|\| !led_set_func)
	46	return;
	47	if (strcmp("Capture Switch", ucontrol->id.name) == 0 && ucontrol->id.index == 0) {
	48	/* TODO: How do I verify if it's a mono or stereo here? */
	49	bool val = ucontrol->value.integer.value[0] \|\| ucontrol->value.integer.value[1];
	50	led_set_func(TPACPI_LED_MICMUTE, !val);
	51	}
	52	}
	53
	54	static void hda_fixup_thinkpad_acpi(struct hda_codec *codec,
	55	const struct hda_fixup *fix, int action)
	56	{
	57	struct hda_gen_spec *spec = codec->spec;
	58	bool removefunc = false;
	59
	60	if (action == HDA_FIXUP_ACT_PROBE) {
	61	if (!is_thinkpad(codec))
	62	return;
	63	if (!led_set_func)
	64	led_set_func = symbol_request(tpacpi_led_set);
	65	if (!led_set_func) {
4e76a883 TI	66	codec_warn(codec,
4e76a883 TI	67	"Failed to find thinkpad-acpi symbol tpacpi_led_set\n");
b317b032 TI	68	return;
	69	}
	70
	71	removefunc = true;
	72	if (led_set_func(TPACPI_LED_MUTE, false) >= 0) {
cf67c8e7	73	old_vmaster_hook = spec->vmaster_mute.hook;
b317b032	74	spec->vmaster_mute.hook = update_tpacpi_mute_led;
7290006d	75	spec->vmaster_mute_enum = 1;
b317b032 TI	76	removefunc = false;
	77	}
	78	if (led_set_func(TPACPI_LED_MICMUTE, false) >= 0) {
	79	if (spec->num_adc_nids > 1)
4e76a883 TI	80	codec_dbg(codec,
4e76a883 TI	81	"Skipping micmute LED control due to several ADCs");
b317b032 TI	82	else {
	83	spec->cap_sync_hook = update_tpacpi_micmute_led;
	84	removefunc = false;
	85	}
	86	}
	87	}
	88
	89	if (led_set_func && (action == HDA_FIXUP_ACT_FREE \|\| removefunc)) {
	90	symbol_put(tpacpi_led_set);
	91	led_set_func = NULL;
cf67c8e7	92	old_vmaster_hook = NULL;
b317b032 TI	93	}
	94	}
	95
	96	#else /* CONFIG_THINKPAD_ACPI */
	97
	98	static void hda_fixup_thinkpad_acpi(struct hda_codec *codec,
	99	const struct hda_fixup *fix, int action)
	100	{
	101	}
	102
	103	#endif /* CONFIG_THINKPAD_ACPI */