Bluetooth-connection between Android and Lego Mindstorm NXT

joen picture joen · Feb 11, 2011 · Viewed 23.5k times · Source

Does anybody know, how to build a bluetooth connection between Android and LEGO-Mindstorm-NXT? The connection between two NXTs works fine. But the other Connection-type likes not so easy. I am working with the LeJOS Firmware 0.85 and the Android SDK Tools (2.2 Froyo).

Answer

joen picture joen · Feb 15, 2011

So i've solved it and will show all how does it works, because i've seen that a lot of people have problems with that.

The class includes 4 functions:

  • Bluetooth enable if not enabled before -> enableBT()
  • Connect to 2 NXTs -> connectToNXTs()
  • Write Message to one of the NXTs -> writeMessage(byte msg, String nxt)
  • Read Message from one of the NXTs -> readMessage(String nxt)

Here is the code for the android device (BT_comm.java):

package de.joen.android.CubeScan;


import java.io.InputStreamReader;
import java.io.OutputStreamWriter;
import java.util.UUID;


import android.bluetooth.BluetoothAdapter;
import android.bluetooth.BluetoothDevice;
import android.bluetooth.BluetoothSocket;

import android.util.Log;

public class BT_Comm {

  //Target NXTs for communication
  final String nxt2 = "00:16:53:04:52:3A";
  final String nxt1 = "00:16:53:07:AA:F6";

  BluetoothAdapter localAdapter;
  BluetoothSocket socket_nxt1, socket_nxt2;
  boolean success = false;

  // Enables Bluetooth if not enabled
  public void enableBT(){
    localAdapter = BluetoothAdapter.getDefaultAdapter();
    // If Bluetooth not enable then do it
    if (!localAdapter.isEnabled()) {
      localAdapter.enable();
      while(!(localAdapter.isEnabled()));
    }
  }

  // Connect to both NXTs
  public boolean connectToNXTs() {

    // Get the BluetoothDevice of the NXT
    BluetoothDevice nxt_2 = localAdapter.getRemoteDevice(nxt2);
    BluetoothDevice nxt_1 = localAdapter.getRemoteDevice(nxt1);
    // Try to connect to the nxt
    try {
      socket_nxt2 = nxt_2.createRfcommSocketToServiceRecord(UUID
          .fromString("00001101-0000-1000-8000-00805F9B34FB"));

      socket_nxt1 = nxt_1.createRfcommSocketToServiceRecord(UUID
          .fromString("00001101-0000-1000-8000-00805F9B34FB"));

      socket_nxt2.connect();    
      socket_nxt1.connect();      

      success = true;

    } catch (IOException e) {
      Log.d("Bluetooth","Err: Device not found or cannot connect");
      success=false;
    }
    return success;    
  }


  public void writeMessage(byte msg, String nxt) throws InterruptedException {
    BluetoothSocket connSock;

    // Swith nxt socket
    if (nxt.equals("nxt2")) {
      connSock=socket_nxt2;
    } else if(nxt.equals("nxt1")) {
      connSock = socket_nxt1;
    } else {
      connSock=null;
    }

    if (connSock!=null) {
      try {

        OutputStreamWriter out = new OutputStreamWriter(connSock.getOutputStream());
        out.write(msg);
        out.flush();

        Thread.sleep(1000);

      } catch (IOException e) {
        // TODO: Auto-generated catch block
        e.printStackTrace();
      }
    } else {
      // Error
    }
  }

  public int readMessage(String nxt) {
    BluetoothSocket connSock;
    int n;

    // Swith nxt socket
    if (nxt.equals("nxt2")) {
      connSock=socket_nxt2;
    } else if (nxt.equals("nxt1")) {
      connSock=socket_nxt1;
    } else {
      connSock=null;
    }

    if (connSock!=null) {
      try {

        InputStreamReader in = new InputStreamReader(connSock.getInputStream());
        n = in.read();
        return n;

      } catch (IOException e) {
        // TODO: Auto-generated catch block
        e.printStackTrace();
        return -1;
      }
    } else {
      // Error
      return -1;
    }
  }
}

To get messages from the Android Smartphone you must have a read call on the NXT-side. Here is the code from the NXT-side wich will accept the connection from the Smartphone and read messages from it:

Boolean isrunning = true;

// Main loop   
while (true)
{
  LCD.drawString(waiting,0,0);
  LCD.refresh();

  // Listen for incoming connection

  NXTConnection btc = Bluetooth.waitForConnection();

  btc.setIOMode(NXTConnection.RAW);

  LCD.clear();
  LCD.drawString(connected,0,0);
  LCD.refresh();  


  // The InputStream for read data 
  DataInputStream dis = btc.openDataInputStream();


  // Loop for read data  
  while (isrunning) {
    Byte n = dis.readByte();
    LCD.clear();
    LCD.drawInt(n, 4, 4);
  }

  dis.close();

  // Wait for data to drain
  Thread.sleep(100); 

  LCD.clear();
  LCD.drawString(closing,0,0);
  LCD.refresh();

  btc.close();

  LCD.clear();
}

Hope this will help others...