--- /dev/null
+/*
+ *
+ * btpasskey 1.0 Copyright (c) 2007 Victor Wagner
+ *
+ * Based on example passkey-agent.c program from
+ *
+ * BlueZ - Bluetooth protocol stack for Linux
+ *
+ * Copyright (C) 2005-2006 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 as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
+ *
+ */
+#ifdef HAVE_CONFIG_H
+#include <config.h>
+#endif
+
+#include <stdio.h>
+#include <errno.h>
+#include <unistd.h>
+#include <stdlib.h>
+#include <signal.h>
+#include <getopt.h>
+#include <string.h>
+
+#include <dbus/dbus.h>
+
+#define INTERFACE "org.bluez.Security"
+char* resolve_bluetooth_name(DBusConnection *conn,const char *adapter,const char *btaddress)
+{
+ DBusMessage *msg;
+ DBusPendingCall *pending;
+ char *name;
+ static char namebuf[256];
+ DBusError err;
+ msg = dbus_message_new_method_call("org.bluez",
+ adapter, "org.bluez.Adapter","GetRemoteName");
+ if (NULL==msg)
+ {
+ fprintf(stderr,"dbus_message_new_method_call error\n");
+ exit(1);
+ }
+ dbus_message_append_args(msg,DBUS_TYPE_STRING,btaddress,DBUS_TYPE_INVALID);
+
+ if (!dbus_connection_send_with_reply(conn, msg, &pending,-1)
+ || NULL==pending)
+ {
+ fprintf(stderr,"Error sending message to system bus\n");
+ exit(1);
+ }
+ dbus_connection_flush(conn);
+ dbus_message_unref(msg);
+ dbus_pending_call_block(pending);
+ msg = dbus_pending_call_steal_reply(pending);
+ if (NULL == msg)
+ {
+ fprintf(stderr,"Error getting call result\n");
+ exit(1);
+ }
+ dbus_pending_call_unref(pending);
+ dbus_error_init(&err);
+ if (!dbus_message_get_args(msg,&err,DBUS_TYPE_STRING,&name,DBUS_TYPE_INVALID))
+ {
+ fprintf(stderr,"Error parsing name request result\n");
+ exit(1);
+ }
+ if (!dbus_error_is_set(&err))
+ {
+ strcpy(namebuf,name);
+ }
+ else
+ {
+ fprintf(stderr,"DBus error %s: %s\n",err.name,
+ err.message);
+ namebuf[0]=0;
+ }
+ dbus_error_free(&err);
+ dbus_message_unref(msg);
+ return namebuf;
+
+
+}
+
+static volatile sig_atomic_t __io_canceled = 0;
+static volatile sig_atomic_t __io_terminated = 0;
+
+static void sig_term(int sig)
+{
+ __io_canceled = 1;
+}
+
+static DBusHandlerResult agent_filter(DBusConnection *conn,
+ DBusMessage *msg, void *data)
+{
+ const char *name, *old, *new;
+
+ if (!dbus_message_is_signal(msg, DBUS_INTERFACE_DBUS, "NameOwnerChanged"))
+ return DBUS_HANDLER_RESULT_NOT_YET_HANDLED;
+
+ if (!dbus_message_get_args(msg, NULL,
+ DBUS_TYPE_STRING, &name, DBUS_TYPE_STRING, &old,
+ DBUS_TYPE_STRING, &new, DBUS_TYPE_INVALID)) {
+ fprintf(stderr, "Invalid arguments for NameOwnerChanged signal");
+ return DBUS_HANDLER_RESULT_NOT_YET_HANDLED;
+ }
+
+ if (!strcmp(name, "org.bluez") && *new == '\0') {
+ fprintf(stderr, "Passkey service has been terminated\n");
+ __io_terminated = 1;
+ }
+
+ return DBUS_HANDLER_RESULT_NOT_YET_HANDLED;
+}
+
+static DBusHandlerResult request_message(DBusConnection *conn,
+ DBusMessage *msg, void *data)
+{
+ DBusMessage *reply;
+ const char *path, *address;
+ char passbuf[24], *c,*dname;
+ char *passkey = passbuf;
+ int ok=0;
+
+
+ if (!dbus_message_get_args(msg, NULL, DBUS_TYPE_STRING, &path,
+ DBUS_TYPE_STRING, &address, DBUS_TYPE_INVALID)) {
+ fprintf(stderr, "Invalid arguments for passkey Request method");
+ return DBUS_HANDLER_RESULT_NOT_YET_HANDLED;
+ }
+ dname = resolve_bluetooth_name(conn,path,address);
+ if (!dname) dname = "";
+ while (!ok) {
+ printf("Pass key requested for device \"%s\" (%s)\nEnter passkey: ",dname,address);
+ fgets(passkey,sizeof(passbuf),stdin);
+ for (c=passkey;*c && *c!='\n'; c++) {
+ if (!isdigit(*c)) {
+ printf("Invalid passkey. Retry, please\n"); break;
+ }
+ }
+ if (*c=='\n') *c=0;
+ if (!*c && c>passkey) ok=1;
+ if (c==passkey) return DBUS_HANDLER_RESULT_NOT_YET_HANDLED;
+ }
+ reply = dbus_message_new_method_return(msg);
+ if (!reply) {
+ fprintf(stderr, "Can't create reply message\n");
+ return DBUS_HANDLER_RESULT_NOT_YET_HANDLED;
+ }
+
+ dbus_message_append_args(reply, DBUS_TYPE_STRING, &passkey,
+ DBUS_TYPE_INVALID);
+
+ dbus_connection_send(conn, reply, NULL);
+
+ dbus_connection_flush(conn);
+
+ dbus_message_unref(reply);
+
+ return DBUS_HANDLER_RESULT_HANDLED;
+}
+
+static DBusHandlerResult release_message(DBusConnection *conn,
+ DBusMessage *msg, void *data)
+{
+ DBusMessage *reply;
+
+ if (!dbus_message_get_args(msg, NULL, DBUS_TYPE_INVALID)) {
+ fprintf(stderr, "Invalid arguments for passkey Release method");
+ return DBUS_HANDLER_RESULT_NOT_YET_HANDLED;
+ }
+
+ reply = dbus_message_new_method_return(msg);
+ if (!reply) {
+ fprintf(stderr, "Can't create reply message\n");
+ return DBUS_HANDLER_RESULT_NOT_YET_HANDLED;
+ }
+
+ dbus_message_append_args(reply, DBUS_TYPE_INVALID);
+
+ dbus_connection_send(conn, reply, NULL);
+
+ dbus_connection_flush(conn);
+
+ dbus_message_unref(reply);
+
+ if (!__io_canceled)
+ fprintf(stderr, "Passkey service has been released\n");
+
+ __io_terminated = 1;
+
+ return DBUS_HANDLER_RESULT_HANDLED;
+}
+
+static DBusHandlerResult agent_message(DBusConnection *conn,
+ DBusMessage *msg, void *data)
+{
+ if (dbus_message_is_method_call(msg, "org.bluez.PasskeyAgent", "Request"))
+ return request_message(conn, msg, data);
+
+ if (dbus_message_is_method_call(msg, "org.bluez.PasskeyAgent", "Release"))
+ return release_message(conn, msg, data);
+
+ return DBUS_HANDLER_RESULT_NOT_YET_HANDLED;
+}
+
+static const DBusObjectPathVTable agent_table = {
+ .message_function = agent_message,
+};
+
+static int register_agent(DBusConnection *conn, const char *agent_path)
+{
+ DBusMessage *msg, *reply;
+ DBusError err;
+ const char *path, *method;
+
+ if (!dbus_connection_register_object_path(conn, agent_path,
+ &agent_table, NULL)) {
+ fprintf(stderr, "Can't register path object path for agent\n");
+ return -1;
+ }
+
+ path = "/org/bluez";
+ method = "RegisterDefaultPasskeyAgent";
+ msg = dbus_message_new_method_call("org.bluez", path, INTERFACE, method);
+ if (!msg) {
+ fprintf(stderr, "Can't allocate new method call\n");
+ return -1;
+ }
+
+ dbus_message_append_args(msg, DBUS_TYPE_STRING, &agent_path,
+ DBUS_TYPE_INVALID);
+
+ dbus_error_init(&err);
+
+ reply = dbus_connection_send_with_reply_and_block(conn, msg, -1, &err);
+
+ dbus_message_unref(msg);
+
+ if (!reply) {
+ fprintf(stderr, "Can't register passkey agent\n");
+ if (dbus_error_is_set(&err)) {
+ fprintf(stderr, "%s\n", err.message);
+ dbus_error_free(&err);
+ }
+ return -1;
+ }
+
+ dbus_message_unref(reply);
+
+ dbus_connection_flush(conn);
+
+ return 0;
+}
+
+static int unregister_agent(DBusConnection *conn, const char *agent_path)
+{
+ DBusMessage *msg, *reply;
+ DBusError err;
+ const char *path, *method;
+
+ path = "/org/bluez";
+ method = "UnregisterDefaultPasskeyAgent";
+
+ msg = dbus_message_new_method_call("org.bluez", path, INTERFACE, method);
+ if (!msg) {
+ fprintf(stderr, "Can't allocate new method call\n");
+ dbus_connection_unref(conn);
+ exit(1);
+ }
+
+ dbus_message_append_args(msg, DBUS_TYPE_STRING, &agent_path,
+ DBUS_TYPE_INVALID);
+
+ dbus_error_init(&err);
+
+ reply = dbus_connection_send_with_reply_and_block(conn, msg, -1, &err);
+
+ dbus_message_unref(msg);
+
+ if (!reply) {
+ fprintf(stderr, "Can't unregister passkey agent\n");
+ if (dbus_error_is_set(&err)) {
+ fprintf(stderr, "%s\n", err.message);
+ dbus_error_free(&err);
+ }
+ return -1;
+ }
+
+ dbus_message_unref(reply);
+
+ dbus_connection_flush(conn);
+
+ dbus_connection_unregister_object_path(conn, agent_path);
+
+ return 0;
+}
+/* Gets default bluetooth adapter name */
+char *get_default_adapter(DBusConnection *conn)
+{
+ DBusMessage *msg, *reply;
+ char *result=NULL;
+ DBusError err;
+
+ msg = dbus_message_new_method_call("org.bluez", "/org/bluez","org.bluez.Manager", "DefaultAdapter");
+ dbus_error_init(&err);
+ reply = dbus_connection_send_with_reply_and_block(conn, msg, -1, &err);
+ dbus_message_get_args(reply,&err,DBUS_TYPE_STRING,&result,DBUS_TYPE_INVALID);
+ if (dbus_error_is_set(&err))
+ {
+ fprintf(stderr,"Error getting default adapter: %s\n",err.message);
+ dbus_error_free(&err);
+ exit(1);
+ }
+ dbus_message_unref(msg);
+ result=strdup(result);
+ dbus_message_unref(reply);
+ return result;
+}
+
+
+/* Finishes pending call without retriving anything */
+static void finish_pending_call(DBusPendingCall *pending, void *user_data)
+{
+ dbus_pending_call_unref(pending);
+}
+/*Calls specified method of org.bluez.Adapter interface with one or zero
+ * string arguments. If wait for reply is specified, waits, and if
+ * method is not void,
+ * returns string result
+ */
+char *adapter_call(DBusConnection *conn, char *adapter,const char *method,
+ const char *argument, int wait_reply) {
+ DBusMessage *msg, *reply;
+ char *result=NULL;
+ DBusError err;
+ msg = dbus_message_new_method_call("org.bluez", adapter,"org.bluez.Adapter", method);
+ if (argument !=NULL)
+ dbus_message_append_args(msg, DBUS_TYPE_STRING, &argument,
+ DBUS_TYPE_INVALID);
+
+ if (wait_reply) {
+ dbus_error_init(&err);
+ reply = dbus_connection_send_with_reply_and_block(conn, msg, -1, &err);
+ dbus_message_get_args(reply,&err,DBUS_TYPE_STRING,&result,DBUS_TYPE_INVALID);
+ if (result)
+ result=strdup(result);
+ dbus_message_unref(reply);
+ } else {
+ DBusPendingCall *pending;
+ dbus_connection_send_with_reply(conn,msg,&pending,-1);
+ dbus_pending_call_set_notify(pending,finish_pending_call,
+ NULL,NULL);
+
+ }
+ dbus_message_unref(msg);
+ return result;
+}
+
+static void usage(const char *progname)
+{
+ printf("Bluetooth passkey agent ver %s\n\n", VERSION);
+
+ printf("Usage:\n"
+ "\t%s [options]\n"
+ "\n",progname);
+ printf("Options:\n"
+ "\t -p, --path agent-path - set D-Bus object path for agent\n"
+ "\t -d, --discoverable - switch default adapter into discoverable\n"
+ "\t\tmode whie waiting for pairing request\n"
+ "\t -P, --pair address - initiate pairing with specified address\n"
+ "\t -r, --remove address - remove pairing with specified device and exit\n");
+}
+
+static struct option main_options[] = {
+ { "path", 1, 0, 'p' },
+ { "help", 0, 0, 'h' },
+ { "version", 0, 0, 'V'},
+ { "discoverable",0,0,'d' },
+ { "pair",1,0,'P' },
+ { "remove",1,0,'r'},
+ { 0, 0, 0, 0 }
+};
+
+int main(int argc, char *argv[])
+{
+ struct sigaction sa;
+ DBusConnection *conn;
+ char match_string[128], default_path[128], *agent_path = NULL;
+ char *saved_mode=NULL;
+ char *default_adapter=NULL,*pair_address=NULL, *remove_bonding=NULL;
+ int opt,set_mode=0;
+
+ snprintf(default_path, sizeof(default_path),
+ "/org/bluez/passkey_agent_%d", getpid());
+
+ while ((opt = getopt_long(argc, argv, "p:r:P:hVd", main_options, NULL)) != EOF) {
+ switch(opt) {
+ case 'p':
+ if (optarg[0] != '/') {
+ fprintf(stderr, "Invalid path\n");
+ exit(1);
+ }
+ agent_path = strdup(optarg);
+ break;
+ case 'd': set_mode=1;
+ break;
+ case 'P': pair_address=optarg;
+ break;
+ case 'r' : remove_bonding=optarg;
+ break;
+ case 'h':
+ usage(argv[0]);
+
+ exit(0);
+ case 'V':
+ printf("btpasskey " VERSION " Copyright (c) 2007-2008, Victor Wagner\n");
+ default:
+ fprintf(stderr,"Invalid option -%c. Use %s --help\n",
+ opt,argv[0]);
+
+ exit(1);
+ }
+ }
+
+
+
+ if (!agent_path)
+ agent_path = strdup(default_path);
+
+ conn = dbus_bus_get(DBUS_BUS_SYSTEM, NULL);
+ if (!conn) {
+ fprintf(stderr, "Can't get on system bus");
+ exit(1);
+ }
+ if (set_mode || pair_address|| remove_bonding)
+ {
+ /* With these options we need default adapter to interact */
+ default_adapter = get_default_adapter(conn);
+ }
+ if (remove_bonding)
+ {
+ adapter_call(conn,default_adapter,"RemoveBonding",remove_bonding,0);
+ dbus_connection_unref(conn);
+ exit(0);
+ }
+
+ if (register_agent(conn, agent_path) < 0) {
+ dbus_connection_unref(conn);
+ exit(1);
+ }
+
+ if (!dbus_connection_add_filter(conn, agent_filter, NULL, NULL))
+ fprintf(stderr, "Can't add signal filter");
+
+ snprintf(match_string, sizeof(match_string),
+ "interface=%s,member=NameOwnerChanged,arg0=%s",
+ DBUS_INTERFACE_DBUS, "org.bluez");
+
+ dbus_bus_add_match(conn, match_string, NULL);
+
+ memset(&sa, 0, sizeof(sa));
+ sa.sa_flags = SA_NOCLDSTOP;
+ sa.sa_handler = sig_term;
+ sigaction(SIGTERM, &sa, NULL);
+ sigaction(SIGINT, &sa, NULL);
+ sigaction(SIGPIPE, &sa, NULL);
+ setvbuf(stdin,NULL,_IONBF,0);
+ setvbuf(stdout,NULL,_IONBF,0);
+ if (isatty(fileno(stdout)))
+ printf("Waiting for passkey request. Press Ctrl-C to interrupt\n");
+ if (set_mode) {
+ saved_mode=adapter_call(conn,default_adapter,"GetMode",NULL,1);
+ if (strcmp(saved_mode,"discoverable")==0)
+ { /* Already in discoverable state nothing to do*/
+ free(saved_mode);
+ saved_mode=NULL;
+ }
+ else
+ {
+ adapter_call(conn,default_adapter,"SetMode","discoverable",1);
+ }
+ }
+ if (pair_address) {
+ adapter_call(conn,default_adapter,"CreateBonding", pair_address,0);
+ }
+ while (!__io_canceled && !__io_terminated) {
+ if (dbus_connection_read_write_dispatch(conn, 100) != TRUE)
+ break;
+ }
+
+ if (!__io_terminated)
+ unregister_agent(conn, agent_path);
+
+ if (saved_mode) {
+ adapter_call(conn,default_adapter,"SetMode",saved_mode,1);
+ free(saved_mode);
+ }
+ dbus_connection_unref(conn);
+ if (default_adapter) free(default_adapter);
+
+ return 0;
+}
projects / oss / btcli.git / commitdiff