1/* 2 * 3 * BlueZ - Bluetooth protocol stack for Linux 4 * 5 * Copyright (C) 2004-2010 Marcel Holtmann <marcel@holtmann.org> 6 * 7 * 8 * This program is free software; you can redistribute it and/or modify 9 * it under the terms of the GNU General Public License as published by 10 * the Free Software Foundation; either version 2 of the License, or 11 * (at your option) any later version. 12 * 13 * This program is distributed in the hope that it will be useful, 14 * but WITHOUT ANY WARRANTY; without even the implied warranty of 15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 16 * GNU General Public License for more details. 17 * 18 * You should have received a copy of the GNU General Public License 19 * along with this program; if not, write to the Free Software 20 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA 21 * 22 */ 23 24#ifdef HAVE_CONFIG_H 25#include <config.h> 26#endif 27 28#include <errno.h> 29#include <unistd.h> 30#include <sys/socket.h> 31 32#include <bluetooth/bluetooth.h> 33#include <bluetooth/rfcomm.h> 34 35#include <glib.h> 36 37#include <gdbus.h> 38 39#include "plugin.h" 40#include "adapter.h" 41#include "log.h" 42 43static gboolean session_event(GIOChannel *chan, 44 GIOCondition cond, gpointer data) 45{ 46 unsigned char buf[672]; 47 gsize len, written; 48 GIOError err; 49 50 if (cond & (G_IO_HUP | G_IO_ERR | G_IO_NVAL)) 51 return FALSE; 52 53 err = g_io_channel_read(chan, (gchar *) buf, sizeof(buf), &len); 54 if (err == G_IO_ERROR_AGAIN) 55 return TRUE; 56 57 g_io_channel_write(chan, (const gchar *) buf, len, &written); 58 59 return TRUE; 60} 61 62static gboolean connect_event(GIOChannel *chan, 63 GIOCondition cond, gpointer data) 64{ 65 GIOChannel *io; 66 struct sockaddr_rc addr; 67 socklen_t optlen; 68 char address[18]; 69 int sk, nsk; 70 71 sk = g_io_channel_unix_get_fd(chan); 72 73 memset(&addr, 0, sizeof(addr)); 74 optlen = sizeof(addr); 75 76 nsk = accept(sk, (struct sockaddr *) &addr, &optlen); 77 if (nsk < 0) 78 return TRUE; 79 80 io = g_io_channel_unix_new(nsk); 81 g_io_channel_set_close_on_unref(io, TRUE); 82 83 ba2str(&addr.rc_bdaddr, address); 84 85 g_io_add_watch(io, G_IO_IN | G_IO_HUP | G_IO_ERR | G_IO_NVAL, 86 session_event, NULL); 87 88 return TRUE; 89} 90 91static GIOChannel *setup_rfcomm(uint8_t channel) 92{ 93 GIOChannel *io; 94 struct sockaddr_rc addr; 95 int sk; 96 97 sk = socket(PF_BLUETOOTH, SOCK_STREAM, BTPROTO_RFCOMM); 98 if (sk < 0) 99 return NULL; 100 101 memset(&addr, 0, sizeof(addr)); 102 addr.rc_family = AF_BLUETOOTH; 103 bacpy(&addr.rc_bdaddr, BDADDR_ANY); 104 addr.rc_channel = channel; 105 106 if (bind(sk, (struct sockaddr *) &addr, sizeof(addr)) < 0) { 107 close(sk); 108 return NULL; 109 } 110 111 if (listen(sk, 10) < 0) { 112 close(sk); 113 return NULL; 114 } 115 116 io = g_io_channel_unix_new(sk); 117 g_io_channel_set_close_on_unref(io, TRUE); 118 119 g_io_add_watch(io, G_IO_IN, connect_event, NULL); 120 121 return io; 122} 123 124static GIOChannel *chan = NULL; 125 126static int echo_probe(struct btd_adapter *adapter) 127{ 128 const char *path = adapter_get_path(adapter); 129 130 DBG("path %s", path); 131 132 chan = setup_rfcomm(23); 133 134 return 0; 135} 136 137static void echo_remove(struct btd_adapter *adapter) 138{ 139 const char *path = adapter_get_path(adapter); 140 141 DBG("path %s", path); 142 143 g_io_channel_unref(chan); 144} 145 146static struct btd_adapter_driver echo_server = { 147 .name = "echo-server", 148 .probe = echo_probe, 149 .remove = echo_remove, 150}; 151 152static int echo_init(void) 153{ 154 DBG("Setup echo plugin"); 155 156 return btd_register_adapter_driver(&echo_server); 157} 158 159static void echo_exit(void) 160{ 161 DBG("Cleanup echo plugin"); 162 163 btd_unregister_adapter_driver(&echo_server); 164} 165 166BLUETOOTH_PLUGIN_DEFINE(echo, VERSION, 167 BLUETOOTH_PLUGIN_PRIORITY_DEFAULT, echo_init, echo_exit) 168