Revision 0:f56002898ee8, committed 2014-02-20

Comitter:

yihui

Date:

Thu Feb 20 03:30:43 2014 +0000

Commit message:

initial

Changed in this revision

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/BluetoothSerial.cpp	Thu Feb 20 03:30:43 2014 +0000
@@ -0,0 +1,185 @@
+
+#include "BluetoothSerial.h"
+#include <string.h>
+
+#define LOG(args...)   // std::printf(args)
+
+BluetoothSerial::BluetoothSerial(PinName tx, PinName rx) : _serial(tx, rx)
+{   
+
+}
+
+void BluetoothSerial::setup()
+{
+     _serial.baud(BLUETOOTH_SERIAL_DEFAULT_BAUD);
+}
+
+
+void BluetoothSerial::master(const char *name, uint8_t autoc)
+{
+    _serial.puts("\r\n+STWMOD=1\r\n");
+    _serial.printf("\r\n+STNA=%s\r\n", name);
+    _serial.printf("\r\n+STAUTO=%d\r\n", autoc ? 1 : 0);
+}
+
+
+void BluetoothSerial::slave(const char *name, uint8_t autoc, uint8_t oaut)
+{
+    _serial.puts("\r\n+STWMOD=0\r\n");
+    _serial.printf("\r\n+STNA=%s\r\n", name);
+    _serial.printf("\r\n+STOAUT=%d\r\n", oaut ? 1 : 0);
+    _serial.printf("\r\n+STAUTO=%d\r\n", autoc ? 1 : 0);
+}
+
+int BluetoothSerial::connect()
+{
+    clear();
+    _serial.puts("\r\n+INQ=1\r\n"); // Make the bluetooth module inquirable
+    LOG("BT: INQUIRING\r\n");
+    
+    const char *prefix = "CONNECT:";
+    uint8_t prefix_len = sizeof("CONNECT:") - 1;
+    for (uint8_t i = 0; i < 12; i++) {
+        int len = readline(_buf, sizeof(_buf));
+        if (len > 0) {
+            LOG("%s\r\n", _buf);
+            if (!memcmp(_buf, prefix, prefix_len)) {    // check prefix
+                const char *suffix = "OK";
+                uint8_t suffix_len = sizeof("OK") - 1;
+                
+                if (!memcmp(_buf + prefix_len, suffix, suffix_len)) { // check suffix
+                    LOG("BT: CONNECTED\r\n");
+                    return 1;
+                }
+                
+                suffix = "FAIL";
+                suffix_len = sizeof("FAIL") - 1;
+                
+                if (!memcmp(_buf + prefix_len, suffix, suffix_len)) { // check suffix
+                    return 0;
+                }
+            }
+        }
+    }
+    
+    return 0;
+}
+
+int BluetoothSerial::connect(const char *name)
+{
+    char *mac;
+    int name_len = strlen(name);
+    
+    clear();
+    _serial.puts("\r\n+INQ=1\r\n");
+    LOG("BT: INQUERING\r\n");
+    while (1) {
+        int len = readline(_buf, sizeof(_buf));     // +RTINQ=XX,XX,X,X,X,X;DEVICE_NAME
+        if (len > 0) {
+            LOG("%s\r\n", _buf);
+            if (!memcmp(_buf, "+RTINQ=", sizeof("+RTINQ=") - 1)) {  // check prefix
+                
+                if (!memcmp(_buf + len - name_len, name, name_len)) { // check suffix
+                    _buf[len - name_len - 1] = '\0';
+                    mac = (char*)_buf + sizeof("+RTINQ=") - 1;
+                    LOG("Connecting device: %s\r\n", mac);
+                    
+                    break;
+                }
+            }
+
+        }
+        
+    }
+    
+    LOG("BT: CONNECTING\r\n");
+    _serial.printf("\r\n+CONN=%s\r\n", mac);
+    
+    const char *prefix = "CONNECT:";
+    int prefix_len = sizeof("CONNECT:") - 1;
+    for (uint8_t i = 0; i < 6; i++) {
+        int len = readline(_buf, sizeof(_buf), 0);
+        if (len >= 0) {
+            LOG("%s\r\n", _buf);
+            if (!memcmp(_buf, prefix, prefix_len)) {    // check prefix
+                const char *suffix = "OK";
+                uint8_t suffix_len = sizeof("OK") - 1;
+                
+                if (!memcmp(_buf + prefix_len, suffix, suffix_len)) { // check suffix
+                    LOG("BT: CONNECTED\r\n");
+                    return 1;
+                }
+                
+                suffix = "FAIL";
+                suffix_len = sizeof("FAIL") - 1;
+                
+                if (!memcmp(_buf + prefix_len, suffix, suffix_len)) { // check suffix
+                    LOG("TB: CONNECTION FAILED\r\n");
+                    return 0;
+                }
+            }
+        }
+    }
+    
+    return 0;
+}
+    
+
+int BluetoothSerial::_getc()
+{
+    return _serial.getc();
+}
+
+int BluetoothSerial::_putc(int c)
+{
+    return _serial.putc(c);
+}
+
+int BluetoothSerial::readline(uint8_t *buf, int len, uint32_t timeout)
+{
+    int get = 0;
+    int count = timeout;
+    while (count >= 0) {
+        if (_serial.readable()) {
+            char c = _serial.getc();
+            buf[get] = c;
+            if (c == '\n' && get && buf[get - 1] == '\r') {
+                buf[get - 1] = '\0';
+                return get - 1;
+            }
+            get++;
+            if (get >= len) {
+                LOG("Too long line, the buffer is not enough\r\n");
+                return -(get + 1);
+            }
+            
+            count = timeout;
+        }
+        
+        if (timeout != 0) {
+            count--;
+        }
+    }
+
+    return -(get + 1);
+}
+
+void BluetoothSerial::clear()
+{
+    int count = 0;
+    
+    LOG("Clear previous command output\r\n");
+    do {
+        count++;
+        if (_serial.readable()) {
+            int get = _serial.getc();
+            count = 0;
+            
+            LOG("%c", get);
+        }
+    } while (count < BLUETOOTH_SERIAL_TIMEOUT);
+    LOG("done\r\n");
+}
+
+
+   

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/BluetoothSerial.h	Thu Feb 20 03:30:43 2014 +0000
@@ -0,0 +1,69 @@
+/**
+ * The library is for Bluetooth Shield from Seeed Studio
+ */
+
+#ifndef __BLUETOOTH_SERIAL_H__
+#define __BLUETOOTH_SERIAL_H__
+
+#include "mbed.h"
+
+#define BLUETOOTH_SERIAL_DEFAULT_BAUD       38400
+#define BLUETOOTH_SERIAL_TIMEOUT            10000
+#define BLUETOOTH_SERIAL_EOL                "\r\n"
+
+
+class BluetoothSerial : public Stream {
+public:
+    BluetoothSerial(PinName tx, PinName rx);
+    
+    /**
+     * Setup bluetooth module(serial port baud rate)
+     */
+    void setup();
+
+    /**
+     * Set bluetooth module as a master
+     * \param   name    device name
+     * \param   autoc   1: auto-connection, 0 not
+     */
+    void master(const char *name, uint8_t autoc = 0);
+
+    /**
+     * Set bluetooth module as a slave
+     * \param   name    device name
+     * \param   autoc   1: auto-connection, 0 not
+     * \param   oaut    1: permit paired device to connect, 0: not
+     */
+    void slave(const char *name, uint8_t autoc = 0, uint8_t oaut = 1);
+
+    /**
+     * Inquire bluetooth devices and connect the specified device
+     */
+    int connect(const char *name);
+
+    /**
+     * Make the bluetooth module inquirable and available to connect, used in slave mode
+     */
+    int connect();
+    
+    int readable() {
+        return _serial.readable();
+    }
+    
+    int writeable() {
+        return _serial.writeable();
+    }
+
+    
+protected:
+    virtual int _getc();
+    virtual int _putc(int c);
+
+    void clear();
+    int readline(uint8_t *buf, int len, uint32_t timeout = 0);
+    
+    Serial     _serial;
+    uint8_t    _buf[64];  
+};
+
+#endif // __BLUETOOTH_SERIAL_H__