summaryrefslogtreecommitdiffstats
diff options
context:
space:
mode:
authorMarcel Holtmann <marcel@holtmann.org>2007-01-19 23:14:20 +0000
committerMarcel Holtmann <marcel@holtmann.org>2007-01-19 23:14:20 +0000
commit5efa3b9135fb762979bd143a1db31e89ffaae353 (patch)
tree009798bc4fef1e47043cbcf9b44e2f70cb06e9a9
parent717a515646d0fea3c7e30fb5093f96ee54cfb44b (diff)
Implement full echo service
-rw-r--r--daemon/echo.c163
1 files changed, 162 insertions, 1 deletions
diff --git a/daemon/echo.c b/daemon/echo.c
index 8f6e5643..c79b2047 100644
--- a/daemon/echo.c
+++ b/daemon/echo.c
@@ -25,9 +25,16 @@
#include <config.h>
#endif
+#include <unistd.h>
#include <stdlib.h>
#include <string.h>
#include <signal.h>
+#include <sys/socket.h>
+
+#include <bluetooth/bluetooth.h>
+#include <bluetooth/rfcomm.h>
+#include <bluetooth/sdp.h>
+#include <bluetooth/sdp_lib.h>
#include <dbus/dbus.h>
@@ -37,7 +44,146 @@
static GMainLoop *main_loop = NULL;
-static DBusConnection *system_bus = NULL;
+static gboolean session_event(GIOChannel *chan, GIOCondition cond, gpointer data)
+{
+ unsigned char buf[672];
+ gsize len, written;
+ GIOError err;
+
+ if (cond & (G_IO_HUP | G_IO_ERR)) {
+ g_io_channel_unref(chan);
+ return FALSE;
+ }
+
+ err = g_io_channel_read(chan, (gchar *) buf, sizeof(buf), &len);
+ if (err == G_IO_ERROR_AGAIN)
+ return TRUE;
+
+ g_io_channel_write(chan, (const gchar *) buf, len, &written);
+
+ return TRUE;
+}
+
+static gboolean connect_event(GIOChannel *chan, GIOCondition cond, gpointer data)
+{
+ GIOChannel *io;
+ struct sockaddr_rc addr;
+ socklen_t optlen;
+ int sk, nsk;
+
+ sk = g_io_channel_unix_get_fd(chan);
+
+ memset(&addr, 0, sizeof(addr));
+ optlen = sizeof(addr);
+
+ nsk = accept(sk, (struct sockaddr *) &addr, &optlen);
+ if (nsk < 0)
+ return TRUE;
+
+ io = g_io_channel_unix_new(nsk);
+ g_io_channel_set_close_on_unref(io, TRUE);
+
+ g_io_add_watch(io, G_IO_IN | G_IO_HUP | G_IO_ERR,
+ session_event, NULL);
+
+ g_io_channel_unref(io);
+
+ return TRUE;
+}
+
+static GIOChannel *setup_rfcomm(uint8_t channel)
+{
+ GIOChannel *io;
+ struct sockaddr_rc addr;
+ int sk;
+
+ sk = socket(PF_BLUETOOTH, SOCK_STREAM, BTPROTO_RFCOMM);
+ if (sk < 0)
+ return NULL;
+
+ memset(&addr, 0, sizeof(addr));
+ addr.rc_family = AF_BLUETOOTH;
+ bacpy(&addr.rc_bdaddr, BDADDR_ANY);
+ addr.rc_channel = channel;
+
+ if (bind(sk, (struct sockaddr *) &addr, sizeof(addr)) < 0) {
+ close(sk);
+ return NULL;
+ }
+
+ if (listen(sk, 10) < 0) {
+ close(sk);
+ return NULL;
+ }
+
+ io = g_io_channel_unix_new(sk);
+ g_io_channel_set_close_on_unref(io, TRUE);
+
+ g_io_add_watch(io, G_IO_IN, connect_event, NULL);
+
+ g_io_channel_unref(io);
+
+ return io;
+}
+
+static int setup_sdp(uint8_t channel)
+{
+ sdp_session_t *session;
+ sdp_record_t *record;
+ sdp_list_t *svclass, *pfseq, *apseq, *root, *aproto;
+ uuid_t root_uuid, l2cap, rfcomm, spp;
+ sdp_profile_desc_t profile[1];
+ sdp_list_t *proto[2];
+
+ session = sdp_connect(BDADDR_ANY, BDADDR_LOCAL, 0);
+ if (!session) {
+ error("Connection to SDP server failed");
+ return -1;
+ }
+
+ record = sdp_record_alloc();
+ if (!record) {
+ error("Allocation of service record failed");
+ return -1;
+ }
+
+ sdp_uuid16_create(&root_uuid, PUBLIC_BROWSE_GROUP);
+ root = sdp_list_append(NULL, &root_uuid);
+ sdp_set_browse_groups(record, root);
+
+ sdp_uuid16_create(&l2cap, L2CAP_UUID);
+ proto[0] = sdp_list_append(NULL, &l2cap);
+ apseq = sdp_list_append(NULL, proto[0]);
+
+ sdp_uuid16_create(&rfcomm, RFCOMM_UUID);
+ proto[1] = sdp_list_append(NULL, &rfcomm);
+ proto[1] = sdp_list_append(proto[1], sdp_data_alloc(SDP_UINT8, &channel));
+ apseq = sdp_list_append(apseq, proto[1]);
+
+ aproto = sdp_list_append(NULL, apseq);
+ sdp_set_access_protos(record, aproto);
+
+ sdp_uuid16_create(&spp, SERIAL_PORT_SVCLASS_ID);
+ svclass = sdp_list_append(NULL, &spp);
+ sdp_set_service_classes(record, svclass);
+
+ sdp_uuid16_create(&profile[0].uuid, SERIAL_PORT_PROFILE_ID);
+ profile[0].version = 0x0100;
+ pfseq = sdp_list_append(NULL, &profile[0]);
+ sdp_set_profile_descs(record, pfseq);
+
+ sdp_set_info_attr(record, "Echo service", NULL, NULL);
+
+ if (sdp_record_register(session, record, 0) < 0) {
+ error("Registration of service record failed");
+ sdp_record_free(record);
+ return -1;
+ }
+
+ sdp_record_free(record);
+
+ return 0;
+}
static void sig_term(int sig)
{
@@ -50,6 +196,8 @@ static void sig_hup(int sig)
int main(int argc, char *argv[])
{
+ DBusConnection *system_bus;
+ GIOChannel *server_io;
struct sigaction sa;
start_logging("echo", "Bluetooth echo service ver %s", VERSION);
@@ -64,14 +212,27 @@ int main(int argc, char *argv[])
main_loop = g_main_loop_new(NULL, FALSE);
+ server_io = setup_rfcomm(23);
+ if (!server_io) {
+ error("Creation of server channel failed");
+ g_main_loop_unref(main_loop);
+ exit(1);
+ }
+
+ setup_sdp(23);
+
system_bus = init_dbus(NULL, NULL, NULL);
if (!system_bus) {
error("Connection to system bus failed");
+ g_io_channel_unref(server_io);
+ g_main_loop_unref(main_loop);
exit(1);
}
g_main_loop_run(main_loop);
+ g_io_channel_unref(server_io);
+
dbus_connection_unref(system_bus);
g_main_loop_unref(main_loop);