Added documentation.
This commit is contained in:
@@ -29,6 +29,9 @@ import lejos.nxt.comm.NXTConnection;
|
|||||||
import ve.ucv.ciens.ccg.nxtarbot.threads.MotorControlThread;
|
import ve.ucv.ciens.ccg.nxtarbot.threads.MotorControlThread;
|
||||||
import ve.ucv.ciens.ccg.nxtarbot.threads.SensorReportThread;
|
import ve.ucv.ciens.ccg.nxtarbot.threads.SensorReportThread;
|
||||||
|
|
||||||
|
/**
|
||||||
|
* Core class for the robot module of NxtAR.
|
||||||
|
*/
|
||||||
public class NxtAR_bot{
|
public class NxtAR_bot{
|
||||||
private static DataOutputStream dataOutputStream;
|
private static DataOutputStream dataOutputStream;
|
||||||
private static DataInputStream dataInputStream;
|
private static DataInputStream dataInputStream;
|
||||||
@@ -36,6 +39,10 @@ public class NxtAR_bot{
|
|||||||
private static MotorControlThread recvThread;
|
private static MotorControlThread recvThread;
|
||||||
private static SensorReportThread sendThread;
|
private static SensorReportThread sendThread;
|
||||||
|
|
||||||
|
/**
|
||||||
|
* <p>Finishes the communication threads anc closes the Bluetooth data streams,
|
||||||
|
* then quits the application.</p>
|
||||||
|
*/
|
||||||
private static void quit(){
|
private static void quit(){
|
||||||
if(recvThread != null) recvThread.finish();
|
if(recvThread != null) recvThread.finish();
|
||||||
if(sendThread != null) sendThread.finish();
|
if(sendThread != null) sendThread.finish();
|
||||||
@@ -53,13 +60,23 @@ public class NxtAR_bot{
|
|||||||
System.exit(0);
|
System.exit(0);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* <p>Application entry point.</p>
|
||||||
|
* <p>Resets the motors, calibrates the light sensor and starts the
|
||||||
|
* networking threads.</p>
|
||||||
|
*
|
||||||
|
* @param args Command line arguments.
|
||||||
|
*/
|
||||||
public static void main(String[] args){
|
public static void main(String[] args){
|
||||||
|
// Set a listener to force quit if the ESCAPE button is pressed.
|
||||||
Button.ESCAPE.addButtonListener(new QuitButtonListener());
|
Button.ESCAPE.addButtonListener(new QuitButtonListener());
|
||||||
|
|
||||||
|
// Reset the rotation counts of the motors.
|
||||||
Motor.A.resetTachoCount();
|
Motor.A.resetTachoCount();
|
||||||
Motor.B.resetTachoCount();
|
Motor.B.resetTachoCount();
|
||||||
Motor.C.resetTachoCount();
|
Motor.C.resetTachoCount();
|
||||||
|
|
||||||
|
// Start the light sensor and calibrate it.
|
||||||
LightSensor lightSensor = new LightSensor(SensorPort.S1);
|
LightSensor lightSensor = new LightSensor(SensorPort.S1);
|
||||||
lightSensor.setFloodlight(false);
|
lightSensor.setFloodlight(false);
|
||||||
|
|
||||||
@@ -73,6 +90,8 @@ public class NxtAR_bot{
|
|||||||
lightSensor.calibrateHigh();
|
lightSensor.calibrateHigh();
|
||||||
System.out.println("--/--");
|
System.out.println("--/--");
|
||||||
|
|
||||||
|
// Connect with a Bluetooth device in raw mode. Then get the connection
|
||||||
|
// streams.
|
||||||
bluetoothConnection = Bluetooth.waitForConnection();
|
bluetoothConnection = Bluetooth.waitForConnection();
|
||||||
bluetoothConnection.setIOMode(NXTConnection.RAW);
|
bluetoothConnection.setIOMode(NXTConnection.RAW);
|
||||||
dataOutputStream = bluetoothConnection.openDataOutputStream();
|
dataOutputStream = bluetoothConnection.openDataOutputStream();
|
||||||
@@ -80,6 +99,7 @@ public class NxtAR_bot{
|
|||||||
|
|
||||||
System.out.println("Connected");
|
System.out.println("Connected");
|
||||||
|
|
||||||
|
// Start the networking threads and wait for them to finish.
|
||||||
sendThread = new SensorReportThread(dataOutputStream, lightSensor);
|
sendThread = new SensorReportThread(dataOutputStream, lightSensor);
|
||||||
recvThread = new MotorControlThread(dataInputStream);
|
recvThread = new MotorControlThread(dataInputStream);
|
||||||
|
|
||||||
@@ -94,12 +114,21 @@ public class NxtAR_bot{
|
|||||||
quit();
|
quit();
|
||||||
}
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* <p>Force quit button listener.</p>
|
||||||
|
*/
|
||||||
private static class QuitButtonListener implements ButtonListener{
|
private static class QuitButtonListener implements ButtonListener{
|
||||||
|
/**
|
||||||
|
* Force quit.
|
||||||
|
*/
|
||||||
@Override
|
@Override
|
||||||
public void buttonPressed(Button b) {
|
public void buttonPressed(Button b) {
|
||||||
quit();
|
quit();
|
||||||
}
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* Do nothing.
|
||||||
|
*/
|
||||||
@Override
|
@Override
|
||||||
public void buttonReleased(Button b){ }
|
public void buttonReleased(Button b){ }
|
||||||
}
|
}
|
||||||
|
|||||||
@@ -23,19 +23,49 @@ import lejos.nxt.Battery;
|
|||||||
import lejos.nxt.Motor;
|
import lejos.nxt.Motor;
|
||||||
import ve.ucv.ciens.ccg.nxtarbot.protocol.MotorMasks;
|
import ve.ucv.ciens.ccg.nxtarbot.protocol.MotorMasks;
|
||||||
|
|
||||||
|
/**
|
||||||
|
* <p>Class to control the motors on the robot based on isntructions received via
|
||||||
|
* Bluetooth.</p>
|
||||||
|
*
|
||||||
|
* <p>The instructions are codified on a very simple protocol:<p>
|
||||||
|
* <ul>
|
||||||
|
* <li> Every protocol packet is exactly two bytes long.</li>
|
||||||
|
* <li> The lowest order byte codifies the motor to control and the rotation
|
||||||
|
* direction of the same on it's highest four bits. The lower four bits
|
||||||
|
* indicate that the central motor should return to it's position of
|
||||||
|
* origin. This four bits can also be used for future expansions.
|
||||||
|
* <li> The highest order byte, a number between 0 and 100, contains the
|
||||||
|
* power to send to the motor.</li>
|
||||||
|
* </ul>
|
||||||
|
*/
|
||||||
public class MotorControlThread extends Thread{
|
public class MotorControlThread extends Thread{
|
||||||
private boolean done;
|
private boolean done;
|
||||||
private DataInputStream inputStream;
|
private DataInputStream inputStream;
|
||||||
|
|
||||||
public MotorControlThread(DataInputStream inputStream){
|
/**
|
||||||
|
* Create a new MotorControlThread.
|
||||||
|
*
|
||||||
|
* @param inputStream The stream to receive motor commands from.
|
||||||
|
* @throws NullPointerException If inputStream is null.
|
||||||
|
*/
|
||||||
|
public MotorControlThread(DataInputStream inputStream) throws NullPointerException{
|
||||||
|
if(inputStream == null)
|
||||||
|
throw new NullPointerException("Input stream is null.");
|
||||||
|
|
||||||
done = false;
|
done = false;
|
||||||
this.inputStream = inputStream;
|
this.inputStream = inputStream;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* <p>Marks this thread as ready to finish cleanly.</p>
|
||||||
|
*/
|
||||||
public void finish(){
|
public void finish(){
|
||||||
done = true;
|
done = true;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* <p>Receive and process motor control instructions via Bluetooth.</p>
|
||||||
|
*/
|
||||||
@Override
|
@Override
|
||||||
public void run(){
|
public void run(){
|
||||||
boolean motorA, motorB, motorC, recenterMotorB;
|
boolean motorA, motorB, motorC, recenterMotorB;
|
||||||
@@ -44,9 +74,11 @@ public class MotorControlThread extends Thread{
|
|||||||
|
|
||||||
while(!done){
|
while(!done){
|
||||||
try{
|
try{
|
||||||
|
// Read the two bytes indicated by the protocol.
|
||||||
message[0] = inputStream.readByte();
|
message[0] = inputStream.readByte();
|
||||||
message[1] = inputStream.readByte();
|
message[1] = inputStream.readByte();
|
||||||
|
|
||||||
|
// Decode the instruction parameters.
|
||||||
recenterMotorB = (message[0] & MotorMasks.RECENTER) > 0 ? true : false;
|
recenterMotorB = (message[0] & MotorMasks.RECENTER) > 0 ? true : false;
|
||||||
motorA = (message[0] & MotorMasks.MOTOR_A) > 0 ? true : false;
|
motorA = (message[0] & MotorMasks.MOTOR_A) > 0 ? true : false;
|
||||||
motorB = (message[0] & MotorMasks.MOTOR_B) > 0 ? true : false;
|
motorB = (message[0] & MotorMasks.MOTOR_B) > 0 ? true : false;
|
||||||
@@ -54,6 +86,7 @@ public class MotorControlThread extends Thread{
|
|||||||
direction = (message[0] & MotorMasks.DIRECTION) > 0 ? BasicMotorPort.FORWARD : BasicMotorPort.BACKWARD;
|
direction = (message[0] & MotorMasks.DIRECTION) > 0 ? BasicMotorPort.FORWARD : BasicMotorPort.BACKWARD;
|
||||||
|
|
||||||
if(motorA){
|
if(motorA){
|
||||||
|
// Set motor A to run at specified speed.
|
||||||
Motor.A.setSpeed(message[1] * Battery.getVoltage());
|
Motor.A.setSpeed(message[1] * Battery.getVoltage());
|
||||||
if(direction == BasicMotorPort.FORWARD)
|
if(direction == BasicMotorPort.FORWARD)
|
||||||
Motor.A.forward();
|
Motor.A.forward();
|
||||||
@@ -62,6 +95,7 @@ public class MotorControlThread extends Thread{
|
|||||||
}
|
}
|
||||||
|
|
||||||
if(motorB){
|
if(motorB){
|
||||||
|
// Set motor B to run at specified speed.
|
||||||
Motor.B.setSpeed(message[1] * Battery.getVoltage());
|
Motor.B.setSpeed(message[1] * Battery.getVoltage());
|
||||||
if(direction == BasicMotorPort.FORWARD)
|
if(direction == BasicMotorPort.FORWARD)
|
||||||
Motor.B.forward();
|
Motor.B.forward();
|
||||||
@@ -70,6 +104,7 @@ public class MotorControlThread extends Thread{
|
|||||||
}
|
}
|
||||||
|
|
||||||
if(motorC){
|
if(motorC){
|
||||||
|
// Set motor C to run at specified speed.
|
||||||
Motor.C.setSpeed(message[1] * Battery.getVoltage());
|
Motor.C.setSpeed(message[1] * Battery.getVoltage());
|
||||||
if(direction == BasicMotorPort.FORWARD)
|
if(direction == BasicMotorPort.FORWARD)
|
||||||
Motor.C.forward();
|
Motor.C.forward();
|
||||||
@@ -78,6 +113,8 @@ public class MotorControlThread extends Thread{
|
|||||||
}
|
}
|
||||||
|
|
||||||
if(recenterMotorB){
|
if(recenterMotorB){
|
||||||
|
// Return motor B to it's origin. Rotate in the direction
|
||||||
|
// that implies less movement.
|
||||||
tacho = Motor.B.getTachoCount() % 360;
|
tacho = Motor.B.getTachoCount() % 360;
|
||||||
rotation = tacho > 180 ? 360 - tacho : -(tacho);
|
rotation = tacho > 180 ? 360 - tacho : -(tacho);
|
||||||
Motor.B.rotate(rotation);
|
Motor.B.rotate(rotation);
|
||||||
@@ -85,6 +122,7 @@ public class MotorControlThread extends Thread{
|
|||||||
}
|
}
|
||||||
|
|
||||||
}catch(IOException io){
|
}catch(IOException io){
|
||||||
|
// If disconnection terminate.
|
||||||
done = true;
|
done = true;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|||||||
@@ -20,21 +20,43 @@ import java.io.IOException;
|
|||||||
|
|
||||||
import lejos.nxt.LightSensor;
|
import lejos.nxt.LightSensor;
|
||||||
|
|
||||||
|
/**
|
||||||
|
* <p>Class to report the values read from the different sensors through a
|
||||||
|
* Bluetooth stream.</p>
|
||||||
|
*/
|
||||||
public class SensorReportThread extends Thread{
|
public class SensorReportThread extends Thread{
|
||||||
private boolean done;
|
private boolean done;
|
||||||
private LightSensor lightSensor;
|
private LightSensor lightSensor;
|
||||||
private DataOutputStream outputStream;
|
private DataOutputStream outputStream;
|
||||||
|
|
||||||
public SensorReportThread(DataOutputStream outputStream, LightSensor lightSensor){
|
/**
|
||||||
|
* <p>Create a new SensorReportThread.</p>
|
||||||
|
*
|
||||||
|
* @param outputStream The stream to send the data to.
|
||||||
|
* @param lightSensor An initialized and calibrated light sensor.
|
||||||
|
*/
|
||||||
|
public SensorReportThread(DataOutputStream outputStream, LightSensor lightSensor) throws NullPointerException{
|
||||||
|
if(outputStream == null)
|
||||||
|
throw new NullPointerException("Output stream is null.");
|
||||||
|
|
||||||
|
if(lightSensor == null)
|
||||||
|
throw new NullPointerException("Sensor is null.");
|
||||||
|
|
||||||
this.lightSensor = lightSensor;
|
this.lightSensor = lightSensor;
|
||||||
done = false;
|
done = false;
|
||||||
this.outputStream = outputStream;
|
this.outputStream = outputStream;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* <p>Marks this thread as ready to finish cleanly.</p>
|
||||||
|
*/
|
||||||
public void finish(){
|
public void finish(){
|
||||||
done = true;
|
done = true;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* <p>Writes the values read from the light sensor to the output stream.</p>
|
||||||
|
*/
|
||||||
@Override
|
@Override
|
||||||
public void run(){
|
public void run(){
|
||||||
byte message = 0;
|
byte message = 0;
|
||||||
@@ -44,8 +66,8 @@ public class SensorReportThread extends Thread{
|
|||||||
message = (byte)lightSensor.getLightValue();
|
message = (byte)lightSensor.getLightValue();
|
||||||
outputStream.writeByte(message);
|
outputStream.writeByte(message);
|
||||||
outputStream.flush();
|
outputStream.flush();
|
||||||
|
|
||||||
}catch(IOException io){
|
}catch(IOException io){
|
||||||
|
// If disconnection terminate.
|
||||||
done = true;
|
done = true;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|||||||
Reference in New Issue
Block a user