diff options
| -rw-r--r-- | daemon/echo.c | 163 |
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); |