Blame hdajacksensetest/hdajacksensetest.c

Packit 427e91
/*
Packit 427e91
 * Checks the current pin/jack status of the codec
Packit 427e91
 *
Packit 427e91
 * Copyright (c) 2014 David Henningsson, Canonical Ltd. <david.henningsson@canonical.com>
Packit 427e91
 * (With some minor pieces copy-pasted from hda-verb by Takashi Iwai)
Packit 427e91
 *
Packit 427e91
 * Licensed under GPL v2 or later.
Packit 427e91
 */
Packit 427e91
Packit 427e91
Packit 427e91
#include <stdlib.h>
Packit 427e91
#include <stdio.h>
Packit 427e91
#include <fcntl.h>
Packit 427e91
#include <unistd.h>
Packit 427e91
#include <glib.h>
Packit 427e91
#include <errno.h>
Packit 427e91
#include "sysfs-pin-configs.h"
Packit 427e91
Packit 427e91
#include <sys/ioctl.h>
Packit 427e91
#include <stdint.h>
Packit 427e91
typedef uint8_t u8;
Packit 427e91
typedef uint16_t u16;
Packit 427e91
typedef uint32_t u32;
Packit 427e91
typedef uint64_t u64;
Packit 427e91
#include "hda_hwdep.h"
Packit 427e91
Packit 427e91
gint card_index, codec_index;
Packit 427e91
gboolean try_all_pins, set_pin_sense;
Packit 427e91
Packit 427e91
static GOptionEntry arg_entries[] =
Packit 427e91
{
Packit 427e91
  { "card", 'c', 0, G_OPTION_ARG_INT, &card_index, "card index (as can be seen in /proc/asound/cards)", "X" },
Packit 427e91
  { "codec", 'd', 0, G_OPTION_ARG_INT, &codec_index, "codec device index (as can be seen in /proc/asound/cardX/codecY)", "Y" },
Packit 427e91
  { "allpins", 'a', 0, G_OPTION_ARG_NONE, &try_all_pins, "try all pins, even those who (probably) does not have a physical jack", NULL },
Packit 427e91
  { "setpinsense", 's', 0, G_OPTION_ARG_NONE, &set_pin_sense, "execute 'Set pin sense' before the pin sense is measured", NULL },
Packit 427e91
  { NULL }
Packit 427e91
};
Packit 427e91
Packit 427e91
static void parse_command_line(int argc, char **argv)
Packit 427e91
{
Packit 427e91
	GError *error = NULL;
Packit 427e91
	GOptionContext *context = g_option_context_new("- check current jack/pin sense");
Packit 427e91
	g_option_context_add_main_entries(context, arg_entries, NULL);
Packit 427e91
	if (!g_option_context_parse (context, &argc, &argv, &error)) {
Packit 427e91
		fprintf(stderr, "Option parsing failed: %s\n", error->message);
Packit 427e91
		exit(1);
Packit 427e91
	}
Packit 427e91
	g_option_context_free(context);
Packit 427e91
}
Packit 427e91
Packit 427e91
Packit 427e91
static gboolean should_check_pin(pin_configs_t *pin)
Packit 427e91
{
Packit 427e91
	unsigned long defcfg = actual_pin_config(pin);
Packit 427e91
	if (try_all_pins)
Packit 427e91
		return TRUE;
Packit 427e91
	if (get_port_conn(defcfg) != 0)
Packit 427e91
		return FALSE; // Not a jack
Packit 427e91
	if (defcfg & (1 << 8)) // Jack has NO_PRESENCE set
Packit 427e91
		return FALSE;
Packit 427e91
	return TRUE;
Packit 427e91
}
Packit 427e91
Packit 427e91
int fd;
Packit 427e91
Packit 427e91
static void codec_open()
Packit 427e91
{
Packit 427e91
	char filename[64];
Packit 427e91
	int version = 0;
Packit 427e91
Packit 427e91
	snprintf(filename, 64, "/dev/snd/hwC%dD%d", card_index, codec_index);
Packit 427e91
	fd = open(filename, O_RDWR);
Packit 427e91
	if (fd < 0) {
Packit 427e91
		if (errno == EACCES)
Packit 427e91
			fprintf(stderr, "Permission error (hint: this program usually requires root)\n");
Packit 427e91
		else
Packit 427e91
			fprintf(stderr, "Ioctl call failed with error %d\n", errno);
Packit 427e91
		exit(1);
Packit 427e91
	}
Packit 427e91
Packit 427e91
	if (ioctl(fd, HDA_IOCTL_PVERSION, &version) < 0) {
Packit 427e91
		fprintf(stderr, "Ioctl call failed with error %d\n", errno);
Packit 427e91
		fprintf(stderr, "Looks like an invalid hwdep device...\n");
Packit 427e91
		close(fd);
Packit 427e91
		exit(1);
Packit 427e91
	}
Packit 427e91
	if (version < HDA_HWDEP_VERSION) {
Packit 427e91
		fprintf(stderr, "Invalid version number 0x%x\n", version);
Packit 427e91
		fprintf(stderr, "Looks like an invalid hwdep device...\n");
Packit 427e91
		close(fd);
Packit 427e91
		exit(1);
Packit 427e91
	}
Packit 427e91
}
Packit 427e91
Packit 427e91
static unsigned long codec_rw(int nid, int verb, int param)
Packit 427e91
{
Packit 427e91
	struct hda_verb_ioctl val;
Packit 427e91
Packit 427e91
	val.verb = HDA_VERB(nid, verb, param);
Packit 427e91
	if (ioctl(fd, HDA_IOCTL_VERB_WRITE, &val) < 0) {
Packit 427e91
		fprintf(stderr, "Ioctl call failed with error %d\n", errno);
Packit 427e91
		close(fd);
Packit 427e91
		exit(1);
Packit 427e91
	}
Packit 427e91
	return val.res;
Packit 427e91
}
Packit 427e91
Packit 427e91
#define AC_VERB_GET_PIN_SENSE	0x0f09
Packit 427e91
#define AC_VERB_SET_PIN_SENSE	0x709
Packit 427e91
Packit 427e91
#define MAX_PINS 32
Packit 427e91
Packit 427e91
pin_configs_t pin_configs[MAX_PINS];
Packit 427e91
Packit 427e91
int main(int argc, char **argv)
Packit 427e91
{
Packit 427e91
	int pin_count, i;
Packit 427e91
Packit 427e91
	parse_command_line(argc, argv);
Packit 427e91
	pin_count = get_pin_configs_list(pin_configs, MAX_PINS, card_index, codec_index);
Packit 427e91
	if (pin_count == 0) {
Packit 427e91
		fprintf(stderr, "No pins found for card %d codec %d, did you pick the right one?\n", card_index, codec_index);
Packit 427e91
		exit(1);
Packit 427e91
	}
Packit 427e91
Packit 427e91
	codec_open();
Packit 427e91
Packit 427e91
	if (set_pin_sense) {
Packit 427e91
		for (i = 0; i < pin_count; i++)
Packit 427e91
			if (should_check_pin(&pin_configs[i])) {
Packit 427e91
				codec_rw(pin_configs[i].nid, AC_VERB_SET_PIN_SENSE, 0);
Packit 427e91
			}
Packit 427e91
		sleep(1);
Packit 427e91
	}
Packit 427e91
Packit 427e91
	for (i = 0; i < pin_count; i++)
Packit 427e91
		if (should_check_pin(&pin_configs[i])) {
Packit 427e91
			gchar *desc = get_config_description(actual_pin_config(&pin_configs[i]));
Packit 427e91
			unsigned long present = codec_rw(pin_configs[i].nid, AC_VERB_GET_PIN_SENSE, 0);
Packit 427e91
			printf("Pin 0x%.2x (%s): present = %s\n", pin_configs[i].nid, desc, present & 0x80000000 ? "Yes" : "No");
Packit 427e91
			g_free(desc);
Packit 427e91
		}
Packit 427e91
Packit 427e91
	close(fd);
Packit 427e91
	return 0;
Packit 427e91
}