From 7cc4137b299169997e45e07614966adc55f6f5eb Mon Sep 17 00:00:00 2001 From: Marcel Holtmann Date: Wed, 20 Apr 2005 16:56:29 +0000 Subject: Add pskey utility for changing PCM mapping and boot mode --- tools/Makefile.am | 6 +- tools/pskey.c | 204 ++++++++++++++++++++++++++++++++++++++++++++++++++++++ 2 files changed, 209 insertions(+), 1 deletion(-) create mode 100644 tools/pskey.c 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 + * + * + * 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 +#endif + +#include +#include +#include +#include +#include + +#include +#include +#include + +#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 ] [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); +} -- cgit