Drivers for the mini robot designed for Princeton's MAE 433 course.
Dependencies: mbed-dsp mbed-rtos mbed
Dependents: MAE433_Library_Tester RobotBalancerv2
Diff: HC06Bluetooth.cpp
- Revision:
- 0:9afc272fa65f
- Child:
- 5:e00cc0dab1c7
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/HC06Bluetooth.cpp Fri Jun 24 21:03:20 2016 +0000 @@ -0,0 +1,129 @@ +/* + * HC06Bluetooth.cpp + * + * Created on: Jun 4, 2016 + * Author: Developer + */ + +#include <HC06Bluetooth.hpp> +#include <algorithm> + +/* Static methods used to help configure the Baudrate. */ + +// WARNING: DO NOT CHANGE THESE VALUES, AS THEY ARE USED TO INDEX INTO AN ARRAY FOR IMPLEMENTATION. +enum Baudrate {B1200, B2400, B4800, B9600, B19200, B38400, B57600, B115200, B230400, B460800, B921600, B1382400, END}; +const char* BaudATString[] = {"AT+BAUD1", "AT+BAUD2", "AT+BAUD3", "AT+BAUD4", "AT+BAUD5", "AT+BAUD6", "AT+BAUD7", "AT+BAUD8", "AT+BAUD9", "AT+BAUDA", "AT+BAUDB", "AT+BAUDC"}; +const int32_t BaudATReplyLength[] = {6, 6, 6, 6, 7, 7, 7, 8, 8, 8, 8, 9}; +//const char* BaudATReplyPattern[] = {"OK1200", "OK2400", "OK4800","OK9600","OK19200","OK38400","OK57600","OK115200","OK230400","OK460800","OK921600","OK1382400"}; +const int32_t BaudValue[] = {1200, 2400, 4800, 9600, 19200, 38400, 57600, 115200, 230400, 460800, 921600, 1382400}; + +/* HC06 Bluetooth Class Implementation: */ +HC06Bluetooth::HC06Bluetooth(PinName TX, PinName RX, void (*lineCallbackFunc) (const char* readString), void (*charCallbackFunc) (char readChar)) +: btSerialObj(TX, RX), lineCallbackFunc(lineCallbackFunc), charCallbackFunc(charCallbackFunc) { + btSerialObj.baud(115200); + + // Set the interrupt to be called when a byte is received. + if ((lineCallbackFunc != NULL) || (charCallbackFunc != NULL)) { + btSerialObj.attach(this, &HC06Bluetooth::receiveByteISR); + } +} + +void HC06Bluetooth::runSetup(std::string deviceName, std::string PIN) { + int numCharsReceived = 0; + // Detatch the interrupt. + btSerialObj.attach(NULL); + /* Sweep through a list of Baud rates until we find the one that the device has previously been set to. */ + bool baudFound = false; + Timer timeOut; + timeOut.start(); + // For every baud rate in the list: + for (int i = 0; (i < END) && (!baudFound); i++) { + // Set the communication baud rate to it. + btSerialObj.baud(BaudValue[i]); + // Send the test command "AT" to the device. + btSerialObj.puts("AT"); + // While the time out has not been reached: + for(timeOut.reset(); timeOut.read_ms() < 1000; ) { + // If the serial object is readable, make sure the read character matches the reply string "OK". + if (btSerialObj.readable() && !baudFound) { + baudFound = true; + break; + } + } + } + // Flush whatever's in the input buffer. + while(btSerialObj.readable()) { + btSerialObj.getc(); + } + //Overwrite the Baud rate to 115200. + btSerialObj.puts(BaudATString[B115200]); + btSerialObj.baud(BaudValue[B115200]); + // Wait for the 8 character reply "OK115200" + for(numCharsReceived = 0 ; numCharsReceived < BaudATReplyLength[B115200]; numCharsReceived++) { + //while(!btSerialObj.readable()); + btSerialObj.getc(); + } + + // Set the name of the device. + btSerialObj.puts(("AT+NAME" + deviceName.substr(0,20)).c_str()); + // Wait for the 6 character reply "OKname" + for(numCharsReceived = 0 ; numCharsReceived < 6; numCharsReceived++) { + while(!btSerialObj.readable()); + btSerialObj.getc(); + } + + //Set the password of the device. + btSerialObj.puts(("AT+PIN" + PIN.substr(0, 4)).c_str()); + // Wait for the 8 character reply "OKsetpin" + for(numCharsReceived = 0 ; numCharsReceived < 8; numCharsReceived++) { + while(!btSerialObj.readable()); + btSerialObj.getc(); + } + // Reattach the interrupt. + btSerialObj.attach(this, &HC06Bluetooth::receiveByteISR); +} + +HC06Bluetooth::~HC06Bluetooth() { + // TODO Auto-generated destructor stub +} + +void HC06Bluetooth::print(const char* buffer) { + btSerialObj.puts(buffer); +} + +void HC06Bluetooth::print(char c) { + btSerialObj.putc(c); +} + +void HC06Bluetooth::receiveByteISR() { + while(btSerialObj.readable()) { + // Get the character from the input. + char receivedChar = btSerialObj.getc(); + + // Call the character callback function if it is not null. + if (charCallbackFunc != NULL) { + charCallbackFunc(receivedChar); + } + + // If the character is a newline or carriage return, then call the line callback function. + if ((receivedChar == '\n') || (receivedChar == '\r')) { + // Terminate the buffer with a null character, since that is what strings end with. + receivedChar = '\0'; + dataReceivedBuffer[dataReceivedBufferPos] = receivedChar; + // Copy data from the buffer to a copy. + std::copy(dataReceivedBuffer, dataReceivedBuffer + dataReceivedBufferPos, dataReceivedBufferCopy); + // Reset the buffer position. + dataReceivedBufferPos = 0; + // Call the callback function. + if (lineCallbackFunc != NULL) { + lineCallbackFunc((const char*)dataReceivedBuffer); + } + } + // Otherwise, just place it in the buffer and move on. + else { + dataReceivedBuffer[dataReceivedBufferPos] = receivedChar; + dataReceivedBufferPos++; + } + } +} +