From b254c4abccb1ef8a6de4bd543b8135af071d5f7f Mon Sep 17 00:00:00 2001
From: Nils Faerber <nils.faerber@kernelconcepts.de>
Date: Sun, 5 May 2013 00:30:36 +0200
Subject: [PATCH] Add Linux Bluetooth test application

---
 linux-bt/Makefile       | 16 +++++++
 linux-bt/README.txt     | 16 +++++++
 linux-bt/l2cap_client.c | 95 +++++++++++++++++++++++++++++++++++++++++
 3 files changed, 127 insertions(+)
 create mode 100644 linux-bt/Makefile
 create mode 100644 linux-bt/README.txt
 create mode 100644 linux-bt/l2cap_client.c

diff --git a/linux-bt/Makefile b/linux-bt/Makefile
new file mode 100644
index 0000000..7d3390d
--- /dev/null
+++ b/linux-bt/Makefile
@@ -0,0 +1,16 @@
+CFLAGS = -Wall -O2
+SRC = l2cap_client.c
+PRG = l2cap_client
+
+OBJS = $(SRC:.c=.o)
+
+all: $(PRG)
+
+$(PRG): $(OBJS)
+	$(CC) -o $(PRG) $(OBJS) -lbluetooth
+
+%.o: %c
+	$(CC) -c $(CFLAGS) -o $@ $<
+
+clean:
+	rm -f $(OBJS) $(PRG)
diff --git a/linux-bt/README.txt b/linux-bt/README.txt
new file mode 100644
index 0000000..782090e
--- /dev/null
+++ b/linux-bt/README.txt
@@ -0,0 +1,16 @@
+
+l2cap_client
+
+Is a small test application to test the Bluetooth connection to
+Oswald-MetaWatch. It opens a L2CAP connection to a give Bluetooth address.
+After successful connection establishment it output all data received to
+stdout and send data received from stdin (keyboard) to the watch. Input via
+stdin is not in cbreak mode, i.e. input must be finished with CR before it
+is sent to the watch.
+
+Building
+Simply type "make". Depend on libbluetooth and its development files.
+
+Running
+Start with Bluetooth address of the watch as cmdline argument:
+	l2cap_client 11:22:33:44:55:66
diff --git a/linux-bt/l2cap_client.c b/linux-bt/l2cap_client.c
new file mode 100644
index 0000000..a3fb782
--- /dev/null
+++ b/linux-bt/l2cap_client.c
@@ -0,0 +1,95 @@
+/*
+ * (c) 2013 Nils Faerber, Siegen, Germany
+ * licensed under GPLv2
+ */
+
+#include <stdio.h>
+#include <string.h>
+#include <unistd.h>
+#include <stdlib.h>
+#include <sys/select.h>
+#include <sys/time.h>
+#include <sys/types.h>
+#include <sys/socket.h>
+#include <fcntl.h>
+#include <bluetooth/bluetooth.h>
+#include <bluetooth/l2cap.h>
+
+int main(int argc, char **argv)
+{
+	struct sockaddr_l2 addr = { 0 };
+	int s, status, len, i;
+	char buf[255];
+	char dest[18];
+	fd_set infds;
+	fd_set efds;
+
+	if (argc < 2) {
+		fprintf(stderr, "usage: %s <bt_addr>\n", argv[0]);
+		exit(2);
+	}
+
+	strncpy(dest, argv[1], 18);
+
+	// allocate a socket
+	s = socket(AF_BLUETOOTH, SOCK_SEQPACKET, BTPROTO_L2CAP);
+
+	// set the connection parameters (who to connect to)
+	addr.l2_family = AF_BLUETOOTH;
+	addr.l2_psm = htobs(0x1001);
+	str2ba( dest, &addr.l2_bdaddr );
+
+	// connect to server
+	status = connect(s, (struct sockaddr *)&addr, sizeof(addr));
+
+	// send a message
+	if ( status != 0 ) {
+		perror("open socket");
+		close(s);
+		return -1;
+	}
+
+	fprintf(stderr, "connected\n");
+
+	if (fcntl(0, F_SETFL, O_NONBLOCK) != 0)
+		perror("stdin nonblock");
+	if (fcntl(s, F_SETFL, O_NONBLOCK) != 0)
+		perror("socket nonblock");
+
+	while (1) {
+		FD_ZERO(&infds);
+		FD_SET(s, &infds);
+		FD_SET(0, &infds);
+		FD_ZERO(&efds);
+		FD_SET(s, &efds);
+		status = select(s+1, &infds, NULL, &efds, NULL);
+		// fprintf(stderr, "select = %d\n", status);
+		if ( status > 0) {
+			if (FD_ISSET(0, &infds)) {
+				len = read(0, buf, 240);
+				if (len > 0) {
+					status = write(s, buf, len);
+					if (status < 0)
+						perror("write");
+					fsync(s);
+				}
+			} else if (FD_ISSET(s, &infds)) {
+				len = read(s, buf, 240);
+				// fprintf(stderr, "read = %d\n", len);
+				for (i=0; i<len; i++)
+					fprintf(stderr, "%c", buf[i]);
+				// fprintf(stderr, "\n");
+			} else if (FD_ISSET(s, &efds)) {
+				fprintf(stderr, "e on socket\n");
+			} else
+				fprintf(stderr, "hu?");
+		} else
+			perror("select");
+	};
+
+
+	close(s);
+
+	return 0;
+}
+
-- 
2.39.2