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