Move testing programs from tools directory into the test directory

5 files changed, 1540 insertions, 0 deletions

diff --git a/test/Makefile.am b/test/Makefile.am
new file mode 100644
index 00000000..dc84f46f
--- /dev/null
+++ b/test/Makefile.am
@@ -0,0 +1,5 @@
+#
+#  $Id$
+#
+
+noinst_PROGRAMS	= l2test scotest rctest attest
diff --git a/test/attest.c b/test/attest.c
new file mode 100644
index 00000000..078bb886
--- /dev/null
+++ b/test/attest.c
@@ -0,0 +1,178 @@
+/*
+ *
+ *  Programm for testing AT commands over Bluetooth RFCOMM
+ *
+ *  Copyright (C) 2001-2002  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., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
+ *
+ */
+
+#include <stdio.h>
+#include <errno.h>
+#include <fcntl.h>
+#include <stdlib.h>
+#include <string.h>
+#include <unistd.h>
+#include <termios.h>
+#include <sys/time.h>
+#include <sys/ioctl.h>
+#include <sys/socket.h>
+
+#include <bluetooth/bluetooth.h>
+#include <bluetooth/rfcomm.h>
+
+
+
+static int at_command(int fd, char *cmd, int to)
+{
+	fd_set rfds;
+	struct timeval timeout;
+	unsigned char buf[1024];
+	int sel, len, i, n;
+
+	write(fd, cmd, strlen(cmd));
+
+	for (i = 0; i < 100; i++) {
+
+		FD_ZERO(&rfds);
+		FD_SET(fd, &rfds);
+
+		timeout.tv_sec = 0;
+		timeout.tv_usec = to;
+
+		if ((sel = select(fd + 1, &rfds, NULL, NULL, &timeout)) > 0) {
+
+			if (FD_ISSET(fd, &rfds)) {
+				memset(buf, 0, sizeof(buf));
+				len = read(fd, buf, sizeof(buf));
+				for (n = 0; n < len; n++)
+					printf("%c", buf[n]);
+				if (strstr(buf, "\r\nOK") != NULL)
+					break;
+				if (strstr(buf, "\r\nERROR") != NULL)
+					break;
+				if (strstr(buf, "\r\nCONNECT") != NULL)
+					break;
+			}
+
+		}
+
+	}
+
+	return 0;
+}
+
+
+static int open_device(char *device)
+{
+	int fd;
+	struct termios ti;
+
+	if ((fd = open(device, O_RDWR | O_NOCTTY | O_NONBLOCK)) < 0) {
+		printf("Can't open serial port. %s (%d)\n", strerror(errno), errno);
+		return -1;
+	}
+
+	tcflush(fd, TCIOFLUSH);
+
+	/* Switch tty to RAW mode */
+	cfmakeraw(&ti);
+	tcsetattr(fd, TCSANOW, &ti);
+
+	return fd;
+}
+
+
+static int open_socket(bdaddr_t *bdaddr, uint8_t channel)
+{
+	struct sockaddr_rc remote_addr, local_addr;
+	int s;
+
+	if ((s = socket(PF_BLUETOOTH, SOCK_STREAM, BTPROTO_RFCOMM)) < 0) {
+		printf("Can't create socket. %s (%d)\n", strerror(errno), errno);
+		return -1;
+        }
+
+	memset(&local_addr, 0, sizeof(local_addr));
+	local_addr.rc_family = AF_BLUETOOTH;
+	bacpy(&local_addr.rc_bdaddr, BDADDR_ANY);
+	if (bind(s, (struct sockaddr *)&local_addr, sizeof(local_addr)) < 0) {
+		printf("Can't bind socket. %s (%d)\n", strerror(errno), errno);
+		close(s);
+		return -1;
+	}
+
+	memset(&remote_addr, 0, sizeof(remote_addr));
+	remote_addr.rc_family = AF_BLUETOOTH;
+	bacpy(&remote_addr.rc_bdaddr, bdaddr);
+	remote_addr.rc_channel = channel;
+	if (connect(s, (struct sockaddr *)&remote_addr, sizeof(remote_addr)) < 0) {
+		printf("Can't connect. %s (%d)\n", strerror(errno), errno);
+		close(s);
+		return -1;
+	}
+
+	return s;
+}
+
+
+static void usage(void)
+{
+	printf("Usage:\n\tattest <device> | <bdaddr> [channel]\n");
+}
+
+
+int main(int argc, char *argv[])
+{
+	int fd;
+
+	bdaddr_t bdaddr;
+	uint8_t channel;
+
+	switch (argc) {
+	case 2:
+		str2ba(argv[1], &bdaddr);
+		channel = 1;
+		break;
+	case 3:
+		str2ba(argv[1], &bdaddr);
+		channel = atoi(argv[2]);
+		break;
+	default:
+		usage();
+		exit(-1);
+	}
+
+	if (bacmp(BDADDR_ANY, &bdaddr)) {
+		printf("Connecting to %s on channel %d\n", argv[1], channel);
+		fd = open_socket(&bdaddr, channel);
+	} else {
+		printf("Opening device %s\n", argv[1]);
+		fd = open_device(argv[1]);
+	}
+
+	if (fd < 0)
+		exit(-2);
+
+	at_command(fd, "ATZ\r\n", 10000);
+	at_command(fd, "AT+CPBS=\"ME\"\r\n", 10000);
+	at_command(fd, "AT+CPBR=1,100\r\n", 100000);
+
+	close(fd);
+
+	return 0;
+}
diff --git a/test/l2test.c b/test/l2test.c
new file mode 100644
index 00000000..b08b2d34
--- /dev/null
+++ b/test/l2test.c
@@ -0,0 +1,530 @@
+/* 
+	BlueZ - Bluetooth protocol stack for Linux
+	Copyright (C) 2000-2001 Qualcomm Incorporated
+
+	Written 2000,2001 by Maxim Krasnyansky <maxk@qualcomm.com>
+
+	This program is free software; you can redistribute it and/or modify
+	it under the terms of the GNU General Public License version 2 as
+	published by the Free Software Foundation;
+
+	THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS
+	OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
+	FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT OF THIRD PARTY RIGHTS.
+	IN NO EVENT SHALL THE COPYRIGHT HOLDER(S) AND AUTHOR(S) BE LIABLE FOR ANY CLAIM,
+	OR ANY SPECIAL INDIRECT OR CONSEQUENTIAL DAMAGES, OR ANY DAMAGES WHATSOEVER
+	RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN ACTION OF CONTRACT,
+	NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE
+	USE OR PERFORMANCE OF THIS SOFTWARE.
+
+	ALL LIABILITY, INCLUDING LIABILITY FOR INFRINGEMENT OF ANY PATENTS, COPYRIGHTS,
+	TRADEMARKS OR OTHER RIGHTS, RELATING TO USE OF THIS SOFTWARE IS DISCLAIMED.
+*/
+
+/*
+ * $Id$
+ */
+
+#include <stdio.h>
+#include <stdlib.h>
+#include <unistd.h>
+#include <fcntl.h>
+#include <sys/time.h>
+#include <unistd.h>
+#include <syslog.h>
+#include <string.h>
+#include <errno.h>
+#include <signal.h>
+
+#include <netinet/in.h>
+#include <arpa/inet.h>
+#include <resolv.h>
+#include <netdb.h>
+#include <sys/socket.h>
+
+#include <bluetooth/bluetooth.h>
+#include <bluetooth/l2cap.h>
+
+/* Test modes */
+enum {
+	SEND,
+	RECV,
+	RECONNECT,
+	MULTY,
+	DUMP,
+	CONNECT,
+	CRECV,
+	LSEND
+};
+
+unsigned char *buf;
+
+/* Default mtu */
+int imtu = 672;
+int omtu = 0;
+
+/* Default data size */
+long data_size = 672;
+
+/* Default addr and psm */
+bdaddr_t bdaddr;
+unsigned short psm = 10;
+
+int master = 0;
+int auth = 0;
+int encrypt = 0;
+int socktype = SOCK_SEQPACKET;
+
+float tv2fl(struct timeval tv)
+{
+	return (float)tv.tv_sec + (float)(tv.tv_usec/1000000.0);
+}
+
+int do_connect(char *svr)
+{
+	struct sockaddr_l2 rem_addr, loc_addr;
+	struct l2cap_options opts;
+	int s, opt;
+
+	if( (s = socket(PF_BLUETOOTH, socktype, BTPROTO_L2CAP)) < 0 ) {
+		syslog(LOG_ERR, "Can't create socket. %s(%d)", strerror(errno), errno);
+		return -1;
+	}
+
+	memset(&loc_addr, 0, sizeof(loc_addr));
+	loc_addr.l2_family = AF_BLUETOOTH;
+	loc_addr.l2_bdaddr = bdaddr;
+	if( bind(s, (struct sockaddr *) &loc_addr, sizeof(loc_addr)) < 0 ) {
+		syslog(LOG_ERR, "Can't bind socket. %s(%d)", strerror(errno), errno);
+		exit(1);
+	}
+
+	/* Get default options */
+	opt = sizeof(opts);
+	if( getsockopt(s, SOL_L2CAP, L2CAP_OPTIONS, &opts, &opt) < 0 ) {
+		syslog(LOG_ERR, "Can't get default L2CAP options. %s(%d)", strerror(errno), errno);
+		return -1;	
+	}
+
+	/* Set new options */
+	opts.omtu = omtu;
+	opts.imtu = imtu;
+	if( setsockopt(s, SOL_L2CAP, L2CAP_OPTIONS, &opts, opt) < 0 ) {
+		syslog(LOG_ERR, "Can't set L2CAP options. %s(%d)", strerror(errno), errno);
+		return -1;
+	}
+
+	memset(&rem_addr, 0, sizeof(rem_addr));
+	rem_addr.l2_family = AF_BLUETOOTH;
+	baswap(&rem_addr.l2_bdaddr, strtoba(svr));
+	rem_addr.l2_psm = htobs(psm);
+	if( connect(s, (struct sockaddr *)&rem_addr, sizeof(rem_addr)) < 0 ){
+		syslog(LOG_ERR, "Can't connect. %s(%d)", strerror(errno), errno);
+		close(s);
+		return -1;
+	}
+
+	opt = sizeof(opts);
+	if( getsockopt(s, SOL_L2CAP, L2CAP_OPTIONS, &opts, &opt) < 0 ){
+		syslog(LOG_ERR, "Can't get L2CAP options. %s(%d)", strerror(errno), errno);
+		close(s);
+		return -1;
+	}
+
+	syslog(LOG_INFO, "Connected [imtu %d, omtu %d, flush_to %d]\n",
+	       opts.imtu, opts.omtu, opts.flush_to);
+
+	return s;
+}
+
+void do_listen( void (*handler)(int sk) )
+{
+	struct sockaddr_l2 loc_addr, rem_addr;
+	struct l2cap_options opts;
+	int  s, s1, opt;
+	bdaddr_t ba;
+
+	if( (s = socket(PF_BLUETOOTH, socktype, BTPROTO_L2CAP)) < 0 ) {
+		syslog(LOG_ERR, "Can't create socket. %s(%d)", strerror(errno), errno);
+		exit(1);
+	}
+
+	loc_addr.l2_family = AF_BLUETOOTH;
+	loc_addr.l2_bdaddr = bdaddr;
+	loc_addr.l2_psm    = htobs(psm);
+	if( bind(s, (struct sockaddr *) &loc_addr, sizeof(loc_addr)) < 0 ) {
+		syslog(LOG_ERR, "Can't bind socket. %s(%d)", strerror(errno), errno);
+		exit(1);
+	}
+
+	/* Set link mode */
+	opt = 0;
+	if (master)
+		 opt |= L2CAP_LM_MASTER;
+
+	if (auth)
+		 opt |= L2CAP_LM_AUTH;
+
+	if (encrypt)
+		 opt |= L2CAP_LM_ENCRYPT;
+
+	if (setsockopt(s, SOL_L2CAP, L2CAP_LM, &opt, sizeof(opt)) < 0) {
+		syslog(LOG_ERR, "Can't set L2CAP link mode. %s(%d)", strerror(errno), errno);
+		exit(1);
+	}
+
+	/* Get default options */
+	opt = sizeof(opts);
+	if (getsockopt(s, SOL_L2CAP, L2CAP_OPTIONS, &opts, &opt) < 0) {
+		syslog(LOG_ERR, "Can't get default L2CAP options. %s(%d)", strerror(errno), errno);
+		exit(1);
+	}
+
+	/* Set new options */
+	opts.imtu = imtu;
+	if (setsockopt(s, SOL_L2CAP, L2CAP_OPTIONS, &opts, opt) < 0) {
+		syslog(LOG_ERR, "Can't set L2CAP options. %s(%d)", strerror(errno), errno);
+		exit(1);
+	}
+
+	if (socktype == SOCK_DGRAM) {
+		handler(s);
+		return;
+	}
+
+	if( listen(s, 10) ) {
+		syslog(LOG_ERR,"Can not listen on the socket. %s(%d)", strerror(errno), errno);
+		exit(1);
+	}
+
+	syslog(LOG_INFO,"Waiting for connection on psm %d ...", psm);
+
+	while(1) {
+		opt = sizeof(rem_addr);
+		if( (s1 = accept(s, (struct sockaddr *)&rem_addr, &opt)) < 0 ) {
+			syslog(LOG_ERR,"Accept failed. %s(%d)", strerror(errno), errno);
+			exit(1);
+		}
+		if( fork() ) {
+			/* Parent */
+			close(s1);
+			continue;
+		}
+		/* Child */
+
+		close(s);
+
+		opt = sizeof(opts);
+		if( getsockopt(s1, SOL_L2CAP, L2CAP_OPTIONS, &opts, &opt) < 0 ) {
+			syslog(LOG_ERR, "Can't get L2CAP options. %s(%d)", strerror(errno), errno);
+			exit(1);
+		}
+
+		baswap(&ba, &rem_addr.l2_bdaddr);
+		syslog(LOG_INFO, "Connect from %s [imtu %d, omtu %d, flush_to %d]\n",
+		       batostr(&ba), opts.imtu, opts.omtu, opts.flush_to);
+
+		handler(s1);
+
+		syslog(LOG_INFO, "Disconnect\n");
+		exit(0);
+	}
+}
+
+void dump_mode(int s)
+{
+	int len;
+
+	syslog(LOG_INFO, "Receiving ...");
+	while ((len = read(s, buf, data_size)) > 0)
+		syslog(LOG_INFO, "Recevied %d bytes\n", len);
+}
+
+void recv_mode(int s)
+{
+	struct timeval tv_beg,tv_end,tv_diff;
+	long total;
+	uint32_t seq;
+
+	syslog(LOG_INFO,"Receiving ...");
+
+	seq = 0;
+	while (1) {
+		gettimeofday(&tv_beg,NULL);
+		total = 0;
+		while (total < data_size) {
+			uint32_t sq;
+			uint16_t l;
+			int i,r;
+
+			if ((r = recv(s, buf, data_size, 0)) <= 0) {
+				if (r < 0)
+					syslog(LOG_ERR, "Read failed. %s(%d)",
+							strerror(errno), errno);
+				return;	
+			}
+
+			/* Check sequence */
+			sq = btohl(*(uint32_t *)buf);
+			if (seq != sq) {
+				syslog(LOG_INFO, "seq missmatch: %d -> %d", seq, sq);
+				seq = sq;
+			}
+			seq++;
+			
+			/* Check length */
+			l = btohs(*(uint16_t *)(buf+4));
+			if (r != l) {
+				syslog(LOG_INFO, "size missmatch: %d -> %d", r, l);
+				continue;
+			}
+			
+			/* Verify data */	
+			for (i=6; i < r; i++) {
+				if (buf[i] != 0x7f)
+					syslog(LOG_INFO, "data missmatch: byte %d 0x%2.2x", i, buf[i]);
+			}
+
+			total += r;
+		}
+		gettimeofday(&tv_end,NULL);
+
+		timersub(&tv_end,&tv_beg,&tv_diff);
+
+		syslog(LOG_INFO,"%ld bytes in %.2f sec, %.2f kB/s",total,
+		       tv2fl(tv_diff), (float)(total / tv2fl(tv_diff) ) / 1024.0);
+	}
+}
+
+void send_mode(int s)
+{
+	uint32_t seq;
+	int i;
+
+	syslog(LOG_INFO,"Sending ...");
+
+	for(i=6; i < data_size; i++)
+		buf[i]=0x7f;
+
+	seq = 0;
+	while (1) {
+		*(uint32_t *) buf = htobl(seq++);
+		*(uint16_t *)(buf+4) = htobs(data_size);
+		
+		if (send(s, buf, data_size, 0) <= 0) {
+			syslog(LOG_ERR, "Send failed. %s(%d)", strerror(errno), errno);
+			exit(1);
+		}
+	}
+}
+
+void reconnect_mode(char *svr)
+{
+	while(1) {
+		int s = do_connect(svr);
+		close(s);
+	}
+}
+
+void connect_mode(char *svr)
+{
+	int s;
+	if ((s = do_connect(svr)) < 0)
+		exit(1);
+	sleep(99999999);
+}
+
+void multi_connect_mode(char *svr)
+{
+	while (1) {
+		int i, s;
+		for (i=0; i<10; i++) {
+			if (fork()) continue;
+
+			/* Child */
+			s = do_connect(svr);
+			usleep(500);
+			close(s);
+			exit(0);
+		}
+		sleep(2);
+	}
+}
+
+void usage(void)
+{
+	printf("l2test - L2CAP testing\n"
+		"Usage:\n");
+	printf("\tl2test <mode> [options] [bdaddr]\n");
+	printf("Modes:\n"
+		"\t-r listen and receive\n"
+		"\t-w listen and send\n"
+		"\t-d listen and dump incomming data\n"
+		"\t-s connect and send\n"
+		"\t-u connect and receive\n"
+		"\t-n connect and be silent\n"
+		"\t-c connect, disconnect, connect, ...\n"
+		"\t-m multiple connects\n");
+
+	printf("Options:\n"
+		"\t[-b bytes] [-S bdaddr] [-P psm]\n"
+	       	"\t[-I imtu] [-O omtu]\n"
+		"\t[-D] use connectionless channel (datagram)\n"
+		"\t[-E] request encryption\n"
+		"\t[-E] request encryption\n"
+	       	"\t[-M] become master\n");
+}
+
+extern int optind,opterr,optopt;
+extern char *optarg;
+
+int main(int argc ,char *argv[])
+{
+	int opt, mode, s, need_addr;
+	struct sigaction sa;
+
+	mode = RECV; need_addr = 0;
+	
+	while ((opt=getopt(argc,argv,"rdscuwmnb:P:I:O:S:MAED")) != EOF) {
+		switch(opt) {
+		case 'r':
+			mode = RECV;
+			break;
+		
+		case 's':
+			mode = SEND;
+			need_addr = 1;
+			break;
+
+		case 'w':
+			mode = LSEND;
+			break;
+
+		case 'u':
+			mode = CRECV;
+			need_addr = 1;
+			break;
+
+		case 'd':
+			mode = DUMP;
+			break;
+
+		case 'c':
+			mode = RECONNECT;
+			need_addr = 1;
+			break;
+
+		case 'n':
+			mode = CONNECT;
+			need_addr = 1;
+			break;
+
+		case 'm':
+			mode = MULTY;
+			need_addr = 1;
+			break;
+
+		case 'b':
+			data_size = atoi(optarg);
+			break;
+
+		case 'S':
+			baswap(&bdaddr, strtoba(optarg));
+			break;
+
+		case 'P':
+			psm = atoi(optarg);
+			break;
+
+		case 'I':
+			imtu = atoi(optarg);
+			break;
+
+		case 'O':
+			omtu = atoi(optarg);
+			break;
+
+		case 'M':
+			master = 1;
+			break;
+
+		case 'A':
+			auth = 1;
+			break;
+
+		case 'E':
+			encrypt = 1;
+			break;
+
+		case 'D':
+			socktype = SOCK_DGRAM;
+			break;
+
+		default:
+			usage();
+			exit(1);
+		}
+	}
+
+	if (need_addr && !(argc - optind)) {
+		usage();
+		exit(1);
+	}
+
+	if (!(buf = malloc(data_size))) {
+		perror("Can't allocate data buffer");
+		exit(1);
+	}
+
+	memset(&sa, 0, sizeof(sa));
+	sa.sa_handler = SIG_IGN;
+	sa.sa_flags   = SA_NOCLDSTOP;
+	sigaction(SIGCHLD, &sa, NULL);
+
+	openlog("l2test", LOG_PERROR | LOG_PID, LOG_LOCAL0);
+
+	switch( mode ){
+		case RECV:
+			do_listen(recv_mode);
+			break;
+
+		case CRECV:
+			s = do_connect(argv[optind]);
+			if (s < 0)
+				exit(1);
+			recv_mode(s);
+			break;
+
+		case DUMP:
+			do_listen(dump_mode);
+			break;
+
+		case SEND:
+			s = do_connect(argv[optind]);
+			if (s < 0)
+				exit(1);
+			send_mode(s);
+			break;
+
+		case LSEND:
+			do_listen(send_mode);
+			break;
+
+		case RECONNECT:
+			reconnect_mode(argv[optind]);
+			break;
+
+		case MULTY:
+			multi_connect_mode(argv[optind]);
+			break;
+
+		case CONNECT:
+			connect_mode(argv[optind]);
+			break;
+	}
+	syslog(LOG_INFO, "Exit");
+
+	closelog();
+
+	return 0;
+}
diff --git a/test/rctest.c b/test/rctest.c
new file mode 100644
index 00000000..0584a6a9
--- /dev/null
+++ b/test/rctest.c
@@ -0,0 +1,469 @@
+/* 
+ 	RFCOMM test tool
+	Copyright (C) 2002 Maxim Krasnyansky <maxk@qualcomm.com>
+
+	This program is free software; you can redistribute it and/or modify
+	it under the terms of the GNU General Public License version 2 as
+	published by the Free Software Foundation;
+
+	THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS
+	OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
+	FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT OF THIRD PARTY RIGHTS.
+	IN NO EVENT SHALL THE COPYRIGHT HOLDER(S) AND AUTHOR(S) BE LIABLE FOR ANY CLAIM,
+	OR ANY SPECIAL INDIRECT OR CONSEQUENTIAL DAMAGES, OR ANY DAMAGES WHATSOEVER
+	RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN ACTION OF CONTRACT,
+	NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE
+	USE OR PERFORMANCE OF THIS SOFTWARE.
+
+	ALL LIABILITY, INCLUDING LIABILITY FOR INFRINGEMENT OF ANY PATENTS, COPYRIGHTS,
+	TRADEMARKS OR OTHER RIGHTS, RELATING TO USE OF THIS SOFTWARE IS DISCLAIMED.
+*/
+
+/*
+ * $Id$
+ */
+
+#include <stdio.h>
+#include <stdlib.h>
+#include <unistd.h>
+#include <fcntl.h>
+#include <sys/time.h>
+#include <unistd.h>
+#include <syslog.h>
+#include <string.h>
+#include <errno.h>
+#include <signal.h>
+
+#include <netinet/in.h>
+#include <arpa/inet.h>
+#include <resolv.h>
+#include <netdb.h>
+#include <sys/socket.h>
+
+#include <bluetooth/bluetooth.h>
+#include <bluetooth/rfcomm.h>
+
+/* Test modes */
+enum {
+	SEND,
+	RECV,
+	RECONNECT,
+	MULTY,
+	DUMP,
+	CONNECT,
+	CRECV,
+	LSEND
+};
+
+unsigned char *buf;
+
+/* Default mtu */
+int imtu = 672;
+int omtu = 0;
+
+/* Default data size */
+long data_size = 127;
+
+/* Default addr and channel */
+bdaddr_t bdaddr;
+uint8_t  channel = 10;
+
+int master = 0;
+int auth = 0;
+int encrypt = 0;
+int socktype = SOCK_STREAM;
+
+float tv2fl(struct timeval tv)
+{
+	return (float)tv.tv_sec + (float)(tv.tv_usec/1000000.0);
+}
+
+int do_connect(char *svr)
+{
+	struct sockaddr_rc rem_addr, loc_addr;
+	int s;
+
+	if( (s = socket(PF_BLUETOOTH, socktype, BTPROTO_RFCOMM)) < 0 ) {
+		syslog(LOG_ERR, "Can't create socket. %s(%d)", strerror(errno), errno);
+		return -1;
+	}
+
+	memset(&loc_addr, 0, sizeof(loc_addr));
+	loc_addr.rc_family = AF_BLUETOOTH;
+	loc_addr.rc_bdaddr = bdaddr;
+	if( bind(s, (struct sockaddr *) &loc_addr, sizeof(loc_addr)) < 0 ) {
+		syslog(LOG_ERR, "Can't bind socket. %s(%d)", strerror(errno), errno);
+		exit(1);
+	}
+
+	memset(&rem_addr, 0, sizeof(rem_addr));
+	rem_addr.rc_family = AF_BLUETOOTH;
+	baswap(&rem_addr.rc_bdaddr, strtoba(svr));
+	rem_addr.rc_channel = channel;
+	if( connect(s, (struct sockaddr *)&rem_addr, sizeof(rem_addr)) < 0 ){
+		syslog(LOG_ERR, "Can't connect. %s(%d)", strerror(errno), errno);
+		close(s);
+		return -1;
+	}
+
+	syslog(LOG_INFO, "Connected");
+
+	return s;
+}
+
+void do_listen( void (*handler)(int sk) )
+{
+	struct sockaddr_rc loc_addr, rem_addr;
+	int  s, s1, opt;
+	bdaddr_t ba;
+
+	if( (s = socket(PF_BLUETOOTH, socktype, BTPROTO_RFCOMM)) < 0 ) {
+		syslog(LOG_ERR, "Can't create socket. %s(%d)", strerror(errno), errno);
+		exit(1);
+	}
+
+	loc_addr.rc_family = AF_BLUETOOTH;
+	loc_addr.rc_bdaddr = bdaddr;
+	loc_addr.rc_channel = channel;
+	if( bind(s, (struct sockaddr *) &loc_addr, sizeof(loc_addr)) < 0 ) {
+		syslog(LOG_ERR, "Can't bind socket. %s(%d)", strerror(errno), errno);
+		exit(1);
+	}
+
+#if 0
+	/* Set link mode */
+	opt = 0;
+	if (master)
+		 opt |= L2CAP_LM_MASTER;
+
+	if (auth)
+		 opt |= L2CAP_LM_AUTH;
+
+	if (encrypt)
+		 opt |= L2CAP_LM_ENCRYPT;
+
+	if (setsockopt(s, SOL_RFCOMM, L2CAP_LM, &opt, sizeof(opt)) < 0) {
+		syslog(LOG_ERR, "Can't set L2CAP link mode. %s(%d)", strerror(errno), errno);
+		exit(1);
+	}
+#endif
+
+	if( listen(s, 10) ) {
+		syslog(LOG_ERR,"Can not listen on the socket. %s(%d)", strerror(errno), errno);
+		exit(1);
+	}
+
+	syslog(LOG_INFO,"Waiting for connection on channel %d ...", channel);
+
+	while(1) {
+		opt = sizeof(rem_addr);
+		if( (s1 = accept(s, (struct sockaddr *)&rem_addr, &opt)) < 0 ) {
+			syslog(LOG_ERR,"Accept failed. %s(%d)", strerror(errno), errno);
+			exit(1);
+		}
+		if( fork() ) {
+			/* Parent */
+			close(s1);
+			continue;
+		}
+		/* Child */
+
+		close(s);
+
+		baswap(&ba, &rem_addr.rc_bdaddr);
+		syslog(LOG_INFO, "Connect from %s \n", batostr(&ba));
+
+		handler(s1);
+
+		syslog(LOG_INFO, "Disconnect\n");
+		exit(0);
+	}
+}
+
+void dump_mode(int s)
+{
+	int len;
+
+	syslog(LOG_INFO, "Receiving ...");
+	while ((len = read(s, buf, data_size)) > 0)
+		syslog(LOG_INFO, "Recevied %d bytes\n", len);
+}
+
+void recv_mode(int s)
+{
+	struct timeval tv_beg,tv_end,tv_diff;
+	long total;
+	uint32_t seq;
+
+	syslog(LOG_INFO,"Receiving ...");
+
+	seq = 0;
+	while (1) {
+		gettimeofday(&tv_beg,NULL);
+		total = 0;
+		while (total < data_size) {
+			//uint32_t sq;
+			//uint16_t l;
+			int r;
+
+			if ((r = recv(s, buf, data_size, 0)) <= 0) {
+				if (r < 0)
+					syslog(LOG_ERR, "Read failed. %s(%d)",
+							strerror(errno), errno);
+				return;	
+			}
+#if 0
+			/* Check sequence */
+			sq = btohl(*(uint32_t *)buf);
+			if (seq != sq) {
+				syslog(LOG_INFO, "seq missmatch: %d -> %d", seq, sq);
+				seq = sq;
+			}
+			seq++;
+			
+			/* Check length */
+			l = btohs(*(uint16_t *)(buf+4));
+			if (r != l) {
+				syslog(LOG_INFO, "size missmatch: %d -> %d", r, l);
+				continue;
+			}
+			
+			/* Verify data */	
+			for (i=6; i < r; i++) {
+				if (buf[i] != 0x7f)
+					syslog(LOG_INFO, "data missmatch: byte %d 0x%2.2x", i, buf[i]);
+			}
+#endif
+			total += r;
+		}
+		gettimeofday(&tv_end,NULL);
+
+		timersub(&tv_end,&tv_beg,&tv_diff);
+
+		syslog(LOG_INFO,"%ld bytes in %.2f sec, %.2f kB/s",total,
+		       tv2fl(tv_diff), (float)(total / tv2fl(tv_diff) ) / 1024.0);
+	}
+}
+
+void send_mode(int s)
+{
+	uint32_t seq;
+	int i;
+
+	syslog(LOG_INFO,"Sending ...");
+
+	for(i=6; i < data_size; i++)
+		buf[i]=0x7f;
+
+	seq = 0;
+	while (1) {
+		*(uint32_t *) buf = htobl(seq++);
+		*(uint16_t *)(buf+4) = htobs(data_size);
+		
+		if (send(s, buf, data_size, 0) <= 0) {
+			syslog(LOG_ERR, "Send failed. %s(%d)", strerror(errno), errno);
+			exit(1);
+		}
+	}
+}
+
+void reconnect_mode(char *svr)
+{
+	while(1) {
+		int s = do_connect(svr);
+		close(s);
+	}
+}
+
+void multi_connect_mode(char *svr)
+{
+	while (1) {
+		int i, s;
+		for (i=0; i<10; i++) {
+			if (fork()) continue;
+
+			/* Child */
+			s = do_connect(svr);
+			usleep(500);
+			close(s);
+			exit(0);
+		}
+		sleep(2);
+	}
+}
+
+void usage(void)
+{
+	printf("rctest - RFCOMM testing\n"
+		"Usage:\n");
+	printf("\trctest <mode> [options] [bdaddr]\n");
+	printf("Modes:\n"
+		"\t-r listen and receive\n"
+		"\t-w listen and send\n"
+		"\t-d listen and dump incomming data\n"
+		"\t-s connect and send\n"
+		"\t-u connect and receive\n"
+		"\t-n connect and be silent\n"
+		"\t-c connect, disconnect, connect, ...\n"
+		"\t-m multiple connects\n");
+
+	printf("Options:\n"
+		"\t[-b bytes] [-S bdaddr] [-P channel]\n"
+	       	"\t[-I imtu] [-O omtu]\n"
+		"\t[-E] request encryption\n"
+		"\t[-E] request encryption\n"
+	       	"\t[-M] become master\n");
+}
+
+extern int optind,opterr,optopt;
+extern char *optarg;
+
+int main(int argc ,char *argv[])
+{
+	int opt, mode, s, need_addr;
+	struct sigaction sa;
+
+	mode = RECV; need_addr = 0;
+	
+	while ((opt=getopt(argc,argv,"rdscuwmnb:P:I:O:S:MAE")) != EOF) {
+		switch(opt) {
+		case 'r':
+			mode = RECV;
+			break;
+		
+		case 's':
+			mode = SEND;
+			need_addr = 1;
+			break;
+
+		case 'w':
+			mode = LSEND;
+			break;
+
+		case 'u':
+			mode = CRECV;
+			need_addr = 1;
+			break;
+
+		case 'd':
+			mode = DUMP;
+			break;
+
+		case 'c':
+			mode = RECONNECT;
+			need_addr = 1;
+			break;
+
+		case 'n':
+			mode = CONNECT;
+			need_addr = 1;
+			break;
+
+		case 'm':
+			mode = MULTY;
+			need_addr = 1;
+			break;
+
+		case 'b':
+			data_size = atoi(optarg);
+			break;
+
+		case 'S':
+			baswap(&bdaddr, strtoba(optarg));
+			break;
+
+		case 'P':
+			channel = atoi(optarg);
+			break;
+
+		case 'I':
+			imtu = atoi(optarg);
+			break;
+
+		case 'O':
+			omtu = atoi(optarg);
+			break;
+
+		case 'M':
+			master = 1;
+			break;
+
+		case 'A':
+			auth = 1;
+			break;
+
+		case 'E':
+			encrypt = 1;
+			break;
+
+		default:
+			usage();
+			exit(1);
+		}
+	}
+
+	if (need_addr && !(argc - optind)) {
+		usage();
+		exit(1);
+	}
+
+	if (!(buf = malloc(data_size))) {
+		perror("Can't allocate data buffer");
+		exit(1);
+	}
+
+	memset(&sa, 0, sizeof(sa));
+	sa.sa_handler = SIG_IGN;
+	sa.sa_flags   = SA_NOCLDSTOP;
+	sigaction(SIGCHLD, &sa, NULL);
+
+	openlog("rctest", LOG_PERROR | LOG_PID, LOG_LOCAL0);
+
+	switch( mode ){
+		case RECV:
+			do_listen(recv_mode);
+			break;
+
+		case CRECV:
+			s = do_connect(argv[optind]);
+			if (s < 0)
+				exit(1);
+			recv_mode(s);
+			break;
+
+		case DUMP:
+			do_listen(dump_mode);
+			break;
+
+		case SEND:
+			s = do_connect(argv[optind]);
+			if (s < 0)
+				exit(1);
+			send_mode(s);
+			break;
+
+		case LSEND:
+			do_listen(send_mode);
+			break;
+
+		case RECONNECT:
+			reconnect_mode(argv[optind]);
+			break;
+
+		case MULTY:
+			multi_connect_mode(argv[optind]);
+			break;
+
+		case CONNECT:
+			s = do_connect(argv[optind]);
+			if (s < 0)
+				exit(1);
+			dump_mode(s);
+			break;
+	}
+	syslog(LOG_INFO, "Exit");
+
+	closelog();
+
+	return 0;
+}
diff --git a/test/scotest.c b/test/scotest.c
new file mode 100644
index 00000000..dcb1acdf
--- /dev/null
+++ b/test/scotest.c
@@ -0,0 +1,358 @@
+/* 
+	BlueZ - Bluetooth protocol stack for Linux
+	Copyright (C) 2000-2001 Qualcomm Incorporated
+
+	Written 2000,2001 by Maxim Krasnyansky <maxk@qualcomm.com>
+
+	This program is free software; you can redistribute it and/or modify
+	it under the terms of the GNU General Public License version 2 as
+	published by the Free Software Foundation;
+
+	THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS
+	OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
+	FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT OF THIRD PARTY RIGHTS.
+	IN NO EVENT SHALL THE COPYRIGHT HOLDER(S) AND AUTHOR(S) BE LIABLE FOR ANY CLAIM,
+	OR ANY SPECIAL INDIRECT OR CONSEQUENTIAL DAMAGES, OR ANY DAMAGES WHATSOEVER
+	RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN ACTION OF CONTRACT,
+	NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN CONNECTION WITH THE
+	USE OR PERFORMANCE OF THIS SOFTWARE.
+
+	ALL LIABILITY, INCLUDING LIABILITY FOR INFRINGEMENT OF ANY PATENTS, COPYRIGHTS,
+	TRADEMARKS OR OTHER RIGHTS, RELATING TO USE OF THIS SOFTWARE IS DISCLAIMED.
+*/
+
+/*
+ * $Id$
+ */
+
+#include <stdio.h>
+#include <stdlib.h>
+#include <unistd.h>
+#include <fcntl.h>
+#include <sys/time.h>
+#include <unistd.h>
+#include <syslog.h>
+#include <string.h>
+#include <errno.h>
+#include <signal.h>
+
+#include <netinet/in.h>
+#include <arpa/inet.h>
+#include <resolv.h>
+#include <netdb.h>
+#include <sys/socket.h>
+
+#include <bluetooth/bluetooth.h>
+#include <bluetooth/sco.h>
+
+/* Test modes */
+enum {
+	SEND,
+	RECV,
+	RECONNECT,
+	MULTY,
+	DUMP
+};
+
+unsigned char *buf;
+
+/* Default data size */
+long data_size = 672;
+
+bdaddr_t bdaddr;
+
+float tv2fl(struct timeval tv)
+{
+	return (float)tv.tv_sec + (float)(tv.tv_usec/1000000.0);
+}
+
+int do_connect(char *svr)
+{
+	struct sockaddr_sco rem_addr, loc_addr;
+	int s;
+
+	if( (s = socket(PF_BLUETOOTH, SOCK_SEQPACKET, BTPROTO_SCO)) < 0 ) {
+		syslog(LOG_ERR, "Can't create socket. %s(%d)", strerror(errno), errno);
+		return -1;
+	}
+
+	memset(&loc_addr, 0, sizeof(loc_addr));
+	loc_addr.sco_family = AF_BLUETOOTH;
+	loc_addr.sco_bdaddr = bdaddr;
+	if( bind(s, (struct sockaddr *) &loc_addr, sizeof(loc_addr)) < 0 ) {
+		syslog(LOG_ERR, "Can't bind socket. %s(%d)", strerror(errno), errno);
+		exit(1);
+	}
+
+	memset(&rem_addr, 0, sizeof(rem_addr));
+	rem_addr.sco_family = AF_BLUETOOTH;
+	baswap(&rem_addr.sco_bdaddr, strtoba(svr));
+	if( connect(s, (struct sockaddr *)&rem_addr, sizeof(rem_addr)) < 0 ){
+		syslog(LOG_ERR, "Can't connect. %s(%d)", strerror(errno), errno);
+		return -1;
+	}
+
+	syslog(LOG_INFO, "Connected\n");
+
+	return s;
+}
+
+void do_listen( void (*handler)(int sk) )
+{
+	struct sockaddr_sco loc_addr, rem_addr;
+	int  s, s1, opt;
+	bdaddr_t ba;
+
+	if( (s = socket(PF_BLUETOOTH, SOCK_SEQPACKET, BTPROTO_SCO)) < 0 ) {
+		syslog(LOG_ERR, "Can't create socket. %s(%d)", strerror(errno), errno);
+		exit(1);
+	}
+
+	loc_addr.sco_family = AF_BLUETOOTH;
+	loc_addr.sco_bdaddr = bdaddr;
+	if( bind(s, (struct sockaddr *) &loc_addr, sizeof(loc_addr)) < 0 ) {
+		syslog(LOG_ERR, "Can't bind socket. %s(%d)", strerror(errno), errno);
+		exit(1);
+	}
+
+	if( listen(s, 10) ) {
+		syslog(LOG_ERR,"Can not listen on the socket. %s(%d)", strerror(errno), errno);
+		exit(1);
+	}
+
+	syslog(LOG_INFO,"Waiting for connection ...");
+
+	while(1) {
+		opt = sizeof(rem_addr);
+		if( (s1 = accept(s, (struct sockaddr *)&rem_addr, &opt)) < 0 ) {
+			syslog(LOG_ERR,"Accept failed. %s(%d)", strerror(errno), errno);
+			exit(1);
+		}
+		if( fork() ) {
+			/* Parent */
+			close(s1);
+			continue;
+		}
+		/* Child */
+
+		close(s);
+
+		baswap(&ba, &rem_addr.sco_bdaddr);
+		syslog(LOG_INFO, "Connect from %s\n", batostr(&ba));
+
+		handler(s1);
+
+		syslog(LOG_INFO, "Disconnect\n");
+		exit(0);
+	}
+}
+
+void dump_mode(int s)
+{
+	int len;
+
+	syslog(LOG_INFO,"Receiving ...");
+	while ((len = read(s, buf, data_size)) > 0)
+		syslog(LOG_INFO, "Recevied %d bytes\n", len);
+}
+
+void recv_mode(int s)
+{
+	struct timeval tv_beg,tv_end,tv_diff;
+	long total;
+	uint32_t seq;
+
+	syslog(LOG_INFO, "Receiving ...");
+
+	seq = 0;
+	while (1) {
+		gettimeofday(&tv_beg,NULL);
+		total = 0;
+		while (total < data_size) {
+			int r;
+			if ((r = recv(s, buf, data_size, 0)) <= 0) {
+				if (r < 0)
+					syslog(LOG_ERR, "Read failed. %s(%d)",
+							strerror(errno), errno);
+				return;	
+			}
+			total += r;
+		}
+		gettimeofday(&tv_end,NULL);
+
+		timersub(&tv_end,&tv_beg,&tv_diff);
+
+		syslog(LOG_INFO,"%ld bytes in %.2fm speed %.2f kb",total,
+		       tv2fl(tv_diff) / 60.0,
+		       (float)( total / tv2fl(tv_diff) ) / 1024.0 );
+	}
+}
+
+void send_mode(char *svr)
+{
+	struct sco_options so;
+	uint32_t seq;
+	int s, i, opt;
+
+	if ((s = do_connect(svr)) < 0) {
+		syslog(LOG_ERR, "Can't connect to the server. %s(%d)", 
+				strerror(errno), errno);
+		exit(1);
+	}
+
+	opt = sizeof(so);
+	if (getsockopt(s, SOL_SCO, SCO_OPTIONS, &so, &opt) < 0) {
+		syslog(LOG_ERR, "Can't get SCO options. %s(%d)", 
+				strerror(errno), errno);
+		exit(1);
+	}	
+
+	
+	syslog(LOG_INFO,"Sending ...");
+
+	for (i=6; i < so.mtu; i++)
+		buf[i]=0x7f;
+
+	seq = 0;
+	while (1) {
+		*(uint32_t *)buf = htobl(seq++);
+		*(uint16_t *)(buf+4) = htobs(data_size);
+		
+		if (send(s, buf, so.mtu, 0) <= 0) {
+			syslog(LOG_ERR, "Send failed. %s(%d)", 
+					strerror(errno), errno);
+			exit(1);
+		}
+		usleep(1);
+	}
+}
+
+void reconnect_mode(char *svr)
+{
+	while(1){
+		int s;
+		if( (s = do_connect(svr)) < 0 ){
+			syslog(LOG_ERR, "Can't connect to the server. %s(%d)", strerror(errno), errno);
+			exit(1);
+		}
+		close(s);
+
+		sleep(5);
+	}
+}
+
+void multy_connect_mode(char *svr)
+{
+	while(1){
+		int i, s;
+		for(i=0; i<10; i++){
+			if( fork() ) continue;
+
+			/* Child */
+			if( (s = do_connect(svr)) < 0 ){
+				syslog(LOG_ERR, "Can't connect to the server. %s(%d)", strerror(errno), errno);
+			}
+			close(s);
+			exit(0);
+		}
+		sleep(19);
+	}
+}
+
+void usage(void)
+{
+	printf("scotest - SCO testing\n"
+		"Usage:\n");
+	printf("\tscotest <mode> [-b bytes] [bd_addr]\n");
+	printf("Modes:\n"
+		"\t-d dump (server)\n"
+		"\t-c reconnect (client)\n"
+		"\t-m multiple connects (client)\n"
+		"\t-r receive (server)\n"
+		"\t-s send (client)\n");
+}
+
+extern int optind,opterr,optopt;
+extern char *optarg;
+
+int main(int argc ,char *argv[])
+{
+	struct sigaction sa;
+	int opt, mode = RECV;
+
+	while ((opt=getopt(argc,argv,"rdscmb:")) != EOF) {
+		switch(opt) {
+		case 'r':
+			mode = RECV;
+			break;
+		
+		case 's':
+			mode = SEND;
+			break;
+
+		case 'd':
+			mode = DUMP;
+			break;
+
+		case 'c':
+			mode = RECONNECT;
+			break;
+
+		case 'm':
+			mode = MULTY;
+			break;
+
+		case 'b':
+			data_size = atoi(optarg);
+			break;
+
+		default:
+			usage();
+			exit(1);
+		}
+	}
+
+	if (!(argc - optind) && (mode!=RECV && mode !=DUMP)) {
+		usage();
+		exit(1);
+	}
+
+	if (!(buf = malloc(data_size))) {
+		perror("Can't allocate data buffer");
+		exit(1);
+	}
+
+	memset(&sa, 0, sizeof(sa));
+	sa.sa_handler = SIG_IGN;
+	sa.sa_flags   = SA_NOCLDSTOP;
+	sigaction(SIGCHLD, &sa, NULL);
+
+	openlog("scotest", LOG_PERROR | LOG_PID, LOG_LOCAL0);
+
+	switch( mode ){
+		case RECV:
+			do_listen(recv_mode);
+			break;
+
+		case DUMP:
+			do_listen(dump_mode);
+			break;
+
+		case SEND:
+			send_mode(argv[optind]);
+			break;
+
+		case RECONNECT:
+			reconnect_mode(argv[optind]);
+			break;
+
+		case MULTY:
+			multy_connect_mode(argv[optind]);
+			break;
+	}
+	syslog(LOG_INFO, "Exit");
+
+	closelog();
+
+	return 0;
+}