Add pskey utility for changing PCM mapping and boot mode

2 files changed, 209 insertions, 1 deletions

diff --git a/tools/Makefile.am b/tools/Makefile.am
index b07f2b19..3dd69b68 100644
--- a/tools/Makefile.am
+++ b/tools/Makefile.am
@@ -14,7 +14,7 @@ sbin_PROGRAMS = hciattach hciconfig $(hid2hci_programs)
 
 bin_PROGRAMS = hcitool l2ping sdptool ciptool
 
-noinst_PROGRAMS = ppporc hcisecfilter
+noinst_PROGRAMS = hcisecfilter ppporc pskey
 
 hciconfig_SOURCES = hciconfig.c csr.h csr.c
 
@@ -32,6 +32,10 @@ ciptool_LDADD = @BLUEZ_LIBS@
 
 ppporc_LDADD = @BLUEZ_LIBS@
 
+pskey_SOURCES = pskey.c csr.h csr.c
+
+pskey_LDADD = @BLUEZ_LIBS@
+
 if HID2HCI
 hid2hci_LDADD = @USB_LIBS@
 endif
diff --git a/tools/pskey.c b/tools/pskey.c
new file mode 100644
index 00000000..01aa921d
--- /dev/null
+++ b/tools/pskey.c
@@ -0,0 +1,204 @@
+/*
+ *
+ *  BlueZ - Bluetooth protocol stack for Linux
+ *
+ *  Copyright (C) 2004-2005  Marcel Holtmann <marcel@holtmann.org>
+ *
+ *
+ *  This program is free software; you can redistribute it and/or modify
+ *  it under the terms of the GNU General Public License version 2 as
+ *  published by the Free Software Foundation;
+ *
+ *  THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS
+ *  OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
+ *  FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT OF THIRD PARTY RIGHTS.
+ *  IN NO EVENT SHALL THE COPYRIGHT HOLDER(S) AND AUTHOR(S) BE LIABLE FOR ANY
+ *  CLAIM, OR ANY SPECIAL INDIRECT OR CONSEQUENTIAL DAMAGES, OR ANY DAMAGES 
+ *  WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN 
+ *  ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF 
+ *  OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
+ *
+ *  ALL LIABILITY, INCLUDING LIABILITY FOR INFRINGEMENT OF ANY PATENTS, 
+ *  COPYRIGHTS, TRADEMARKS OR OTHER RIGHTS, RELATING TO USE OF THIS 
+ *  SOFTWARE IS DISCLAIMED.
+ *
+ *
+ *  $Id$
+ */
+
+#ifdef HAVE_CONFIG_H
+#include <config.h>
+#endif
+
+#include <stdio.h>
+#include <errno.h>
+#include <stdlib.h>
+#include <getopt.h>
+#include <sys/socket.h>
+
+#include <bluetooth/bluetooth.h>
+#include <bluetooth/hci.h>
+#include <bluetooth/hci_lib.h>
+
+#include "csr.h"
+
+#define CSR_TYPE_NULL    0
+#define CSR_TYPE_UINT16  1
+
+static int write_pskey(int dd, uint16_t pskey, int type, int argc, char *argv[])
+{
+	uint16_t value;
+	int err;
+
+	if (type != CSR_TYPE_UINT16) {
+		errno = EFAULT;
+		return -1;
+	}
+
+	if (argc != 1) {
+		errno = E2BIG;
+		return -1;
+	}
+
+	value = atoi(argv[0]);
+
+	err = csr_write_pskey_uint16(dd, 0x4711, pskey, value);
+
+	return err;
+}
+
+static int read_pskey(int dd, uint16_t pskey, int type)
+{
+	uint16_t value;
+	int err;
+
+	if (type != CSR_TYPE_UINT16) {
+		errno = EFAULT;
+		return -1;
+	}
+
+	err = csr_read_pskey_uint16(dd, 0x4711, pskey, &value);
+	if (err < 0)
+		return err;
+
+	printf("%s: %d\n", csr_pskeytostr(pskey), value);
+
+	return err;
+}
+
+static struct {
+	uint16_t pskey;
+	int type;
+	char *str;
+} storage[] = {
+	{ CSR_PSKEY_HOSTIO_MAP_SCO_PCM, CSR_TYPE_UINT16, "mapsco"   },
+	{ CSR_PSKEY_INITIAL_BOOTMODE,   CSR_TYPE_UINT16, "bootmode" },
+	{ 0x0000, CSR_TYPE_NULL, NULL },
+};
+
+static void usage(void)
+{
+	int i;
+
+	printf("pskey - Utility for changing CSR persistent storage\n\n");
+	printf("Usage:\n"
+		"\tpskey [-i <dev>] <key> [value]\n\n");
+
+	printf("Keys:\n\t");
+		for (i = 0; storage[i].pskey; i++)
+			printf("%s ", storage[i].str);
+	printf("\n");
+}
+
+static struct option main_options[] = {
+	{ "help",	0, 0, 'h' },
+	{ "device",	1, 0, 'i' },
+	{ 0, 0, 0, 0 }
+};
+
+int main(int argc, char *argv[])
+{
+	struct hci_dev_info di;
+	struct hci_version ver;
+	int i, err, dd, opt, dev = 0;
+
+	while ((opt=getopt_long(argc, argv, "+i:h", main_options, NULL)) != -1) {
+		switch (opt) {
+		case 'i':
+			dev = hci_devid(optarg);
+			if (dev < 0) {
+				perror("Invalid device");
+				exit(1);
+			}
+			break;
+
+		case 'h':
+		default:
+			usage();
+			exit(0);
+		}
+	}
+
+	argc -= optind;
+	argv += optind;
+	optind = 0;
+
+	if (argc < 1) {
+		usage();
+		exit(1);
+	}
+
+	dd = hci_open_dev(dev);
+	if (dd < 0) {
+		fprintf(stderr, "Can't open device hci%d: %s (%d)\n",
+						dev, strerror(errno), errno);
+		exit(1);
+	}
+
+	if (hci_devinfo(dev, &di) < 0) {
+		fprintf(stderr, "Can't get device info for hci%d: %s (%d)\n",
+						dev, strerror(errno), errno);
+		hci_close_dev(dd);
+		exit(1);
+	}
+
+	if (hci_read_local_version(dd, &ver, 1000) < 0) {
+		fprintf(stderr, "Can't read version info for hci%d: %s (%d)\n",
+						dev, strerror(errno), errno);
+		hci_close_dev(dd);
+		exit(1);
+	}
+
+	if (ver.manufacturer != 10) {
+		fprintf(stderr, "Unsupported manufacturer\n");
+		hci_close_dev(dd);
+		exit(1);
+	}
+
+	for (i = 0; storage[i].pskey; i++) {
+		if (strcasecmp(storage[i].str, argv[0]))
+			continue;
+
+		if (argc > 1)
+			err = write_pskey(dd, storage[i].pskey,
+					storage[i].type, argc - 1, argv + 1);
+		else
+			err = read_pskey(dd, storage[i].pskey, storage[i].type);
+
+		hci_close_dev(dd);
+
+		if (err < 0) {
+			fprintf(stderr, "Can't %s persistent storage: %s (%d)\n",
+				argc > 1 ? "write" : "read", strerror(errno), errno);
+			exit(1);
+		}
+
+		exit(0);
+	}
+
+	fprintf(stderr, "Unsupported persistent storage\n");
+
+	hci_close_dev(dd);
+
+	exit(1);
+}