[src/trunk]: src/usr.sbin/btattach Add option 'test mode'(-t).

[kiyohara <kiyohara%NetBSD.org@localhost>]

details:   https://anonhg.NetBSD.org/src/rev/c7e451e2b164
branches:  trunk
changeset: 752866:c7e451e2b164
user:      kiyohara <kiyohara%NetBSD.org@localhost>
date:      Mon Mar 08 17:59:52 2010 +0000

description:
Add option 'test mode'(-t).
  Can test your Bluetooth module via com-port.
  This mode guess speed for bcsp(4) or btuart(4), if not respond.

diffstat:

 usr.sbin/btattach/btattach.c |  140 +++++++++++++++++++++++++++++++++++++++++-
 1 files changed, 135 insertions(+), 5 deletions(-)

diffs (210 lines):

diff -r 309d585a67c7 -r c7e451e2b164 usr.sbin/btattach/btattach.c
--- a/usr.sbin/btattach/btattach.c      Mon Mar 08 17:41:11 2010 +0000
+++ b/usr.sbin/btattach/btattach.c      Mon Mar 08 17:59:52 2010 +0000
@@ -1,4 +1,4 @@
-/*     $NetBSD: btattach.c,v 1.7 2010/03/08 17:41:11 kiyohara Exp $    */
+/*     $NetBSD: btattach.c,v 1.8 2010/03/08 17:59:52 kiyohara Exp $    */
 
 /*-
  * Copyright (c) 2008 Iain Hibbert
@@ -27,7 +27,7 @@
 
 #include <sys/cdefs.h>
 __COPYRIGHT("@(#) Copyright (c) 2008 Iain Hibbert.  All rights reserved.");
-__RCSID("$NetBSD: btattach.c,v 1.7 2010/03/08 17:41:11 kiyohara Exp $");
+__RCSID("$NetBSD: btattach.c,v 1.8 2010/03/08 17:59:52 kiyohara Exp $");
 
 #include <sys/ioctl.h>
 #include <sys/param.h>
@@ -48,6 +48,7 @@
 
 static void sighandler(int);
 static void usage(void);
+static void test(const char *, tcflag_t, tcflag_t);
 
 static int sigcount = 0;       /* signals received */
 static int opt_debug = 0;      /* global? */
@@ -151,16 +152,17 @@
        struct termios tio;
        unsigned int init_speed, speed;
        tcflag_t cflag, Cflag;
-       int fd, ch, i;
+       int fd, ch, tflag, i;
        const char *name;
        char *ptr;
 
        init_speed = 0;
        cflag = CLOCAL;
        Cflag = 0;
+       tflag = 0;
        name = "btuart";
 
-       while ((ch = getopt(argc, argv, "dFfi:oPp")) != -1) {
+       while ((ch = getopt(argc, argv, "dFfi:oPpt")) != -1) {
                switch (ch) {
                case 'd':
                        opt_debug++;
@@ -193,6 +195,10 @@
                        cflag |= PARENB;
                        break;
 
+               case 't':
+                       tflag = 1;
+                       break;
+
                case '?':
                default:
                        usage();
@@ -201,6 +207,13 @@
        argc -= optind;
        argv += optind;
 
+       if (tflag) {
+               if (argc != 1)
+                       usage();
+               test(argv[0], cflag, Cflag);
+               exit(EXIT_SUCCESS);
+       }
+
        if (argc == 3) {
                name = argv[0];
                argv++;
@@ -287,6 +300,7 @@
 
        fprintf(stderr,
                "Usage: %s [-dFfoPp] [-i speed] [type] tty speed\n"
+               "       %s -t [-dFfoPp] tty\n"
                "\n"
                "Where:\n"
                "\t-d          debug mode (no detach, dump io)\n"
@@ -296,9 +310,10 @@
                "\t-o          odd parity\n"
                "\t-P          no parity\n"
                "\t-p          even parity\n"
+               "\t-t          test mode\n"
                "\n"
                "Known types:\n"
-               "", getprogname());
+               "", getprogname(), getprogname());
 
        for (i = 0; i < __arraycount(types); i++)
                fprintf(stderr, "\t%-12s%s\n", types[i].name, types[i].descr);
@@ -502,3 +517,118 @@
 
        return n;
 }
+
+static void
+test(const char *tty, tcflag_t cflag, tcflag_t Cflag)
+{
+       struct termios tio;
+       int fd, guessed, i, j, k, n;
+       unsigned char buf[32];
+       const int bauds[] = {
+                57600,         /* BCSP specific default */
+               921600,         /* latest major baud rate */
+               115200,         /* old major baud rate */
+
+               460800,
+               230400,
+//              76800,
+                28800,
+                38400,
+                19200,
+                14400,
+                 9600,
+                 7200,
+                 4800,
+                 2400,
+                 1800,
+                 1200,
+                  600,
+                  300,
+                  200,
+                  150,
+                  134,
+                  110,
+                   75,
+                   50,
+       };
+       const unsigned char bcsp_lepkt[] =
+           /* ESC  ------- header -------  --- link establish ---   ESC */
+           { 0xc0, 0x00, 0x41, 0x00, 0xbe, 0xda, 0xdc, 0xed, 0xed, 0xc0 };
+
+       printf("test mode\n");
+
+       /* open tty */
+       if ((fd = open(tty, O_RDWR | O_NONBLOCK | O_EXLOCK, 0)) < 0)
+               err(EXIT_FAILURE, "%s", tty);
+
+       /* setup tty */
+       if (tcgetattr(fd, &tio) < 0)
+               err(EXIT_FAILURE, "tcgetattr");
+       cfmakeraw(&tio);
+       tio.c_cflag |= (CLOCAL | CRTSCTS | PARENB);
+       tio.c_cflag |= cflag;
+       tio.c_cflag &= ~Cflag;
+
+       guessed = 0;
+       for (i = 0; i < __arraycount(bauds); i++) {
+               if (cfsetspeed(&tio, bauds[i]) < 0
+                   || tcsetattr(fd, TCSANOW, &tio) < 0
+                   || tcflush(fd, TCIOFLUSH) < 0)
+                       if (bauds[i] > 115200)
+                               continue;
+                       else
+                               err(EXIT_FAILURE, "tty setup failed");
+
+               if (opt_debug)
+                       printf("  try with B%d\n", bauds[i]);
+
+               sleep(bauds[i] < 9600 ? 3 : 1);
+
+               n = read(fd, buf, sizeof(buf));
+               if (opt_debug > 1)
+                       printf("  %dbyte read\n", n);
+               if (n < 0) {
+                       if (i == 0 && errno == EAGAIN) {
+                               printf("This module is *maybe* supported by btuart(4).\n"
+                                   "you specify aproporiate <speed>.\n"
+                                   "  Also can specify <type> for initialize.\n");
+                               guessed = 1;
+                               break;
+                       }
+                       if (errno == EAGAIN)
+                               continue;
+
+                       err(EXIT_FAILURE, "read");
+               } else {
+                       if (n < sizeof(bcsp_lepkt))
+                               continue;
+                       for (j = 0; j < n - sizeof(bcsp_lepkt); j++) {
+                               for (k = 0; k < sizeof(bcsp_lepkt); k++) 
+                                       if (buf[j + k] != bcsp_lepkt[k]) {
+                                               j += k;
+                                               break;
+                                       }
+                               if (k < sizeof(bcsp_lepkt))
+                                       continue;
+
+                               printf(
+                                   "This module is supported by bcsp(4).\n"
+                                   "  baud rate %d\n",
+                                   bauds[i]);
+                               if (tio.c_cflag & PARENB)
+                                       printf("  with %sparity\n",
+                                           tio.c_cflag & PARODD ? "odd " : "");
+                               guessed = 1;
+                               break;
+                       }
+                       if (guessed)
+                               break;
+               }
+
+       }
+
+       close(fd);
+
+       if (!guessed)
+               printf("don't understand...\n");
+}