Finished the sensor report thread.

This commit is contained in:
2014-04-03 11:30:17 -04:30
parent fe1710b43e
commit 7160cd325e
3 changed files with 41 additions and 29 deletions

View File

@@ -16,7 +16,8 @@
package ve.ucv.ciens.ccg.nxtcam; package ve.ucv.ciens.ccg.nxtcam;
import ve.ucv.ciens.ccg.nxtcam.camera.CameraPreview; import ve.ucv.ciens.ccg.nxtcam.camera.CameraPreview;
import ve.ucv.ciens.ccg.nxtcam.network.LCPThread; import ve.ucv.ciens.ccg.nxtcam.network.NxtBTCommThread;
import ve.ucv.ciens.ccg.nxtcam.network.SensorReportThread;
import ve.ucv.ciens.ccg.nxtcam.network.VideoStreamingThread; import ve.ucv.ciens.ccg.nxtcam.network.VideoStreamingThread;
import ve.ucv.ciens.ccg.nxtcam.utils.Logger; import ve.ucv.ciens.ccg.nxtcam.utils.Logger;
import ve.ucv.ciens.ccg.nxtcam.utils.ProjectConstants; import ve.ucv.ciens.ccg.nxtcam.utils.ProjectConstants;
@@ -40,7 +41,8 @@ public class CamActivity extends Activity{
private CameraPreview cPreview; private CameraPreview cPreview;
private CameraSetupTask camSetupTask; private CameraSetupTask camSetupTask;
private VideoStreamingThread imThread; private VideoStreamingThread imThread;
private LCPThread botThread; private NxtBTCommThread botThread;
private SensorReportThread sensorThread;
private String serverIp; private String serverIp;
/******************* /*******************
@@ -57,8 +59,11 @@ public class CamActivity extends Activity{
imThread = new VideoStreamingThread(serverIp); imThread = new VideoStreamingThread(serverIp);
imThread.start(); imThread.start();
botThread = new LCPThread(serverIp); botThread = new NxtBTCommThread(serverIp);
botThread.start(); botThread.start();
sensorThread = new SensorReportThread(serverIp);
sensorThread.start();
} }
@Override @Override
@@ -92,14 +97,14 @@ public class CamActivity extends Activity{
camSetupTask = new CameraSetupTask(); camSetupTask = new CameraSetupTask();
camSetupTask.execute(); camSetupTask.execute();
// imThread.start(); // TODO: resumethe imThread, botThread and sensorThread objects.
} }
@Override @Override
public void onPause(){ public void onPause(){
super.onPause(); super.onPause();
// TODO: pause the imThread and botThread objects. // TODO: pause the imThread, botThread and sensorThread objects.
if(cPreview != null){ if(cPreview != null){
cPreview.removePreviewCallback(); cPreview.removePreviewCallback();
@@ -113,9 +118,12 @@ public class CamActivity extends Activity{
super.onDestroy(); super.onDestroy();
imThread.finish(); imThread.finish();
imThread = null; imThread = null;
botThread.finish(); botThread.finish();
botThread = null; botThread = null;
sensorThread.finish();
sensorThread = null;
} }
@Override @Override

View File

@@ -23,24 +23,21 @@ import ve.ucv.ciens.ccg.nxtcam.network.protocols.MotorMasks;
import ve.ucv.ciens.ccg.nxtcam.robotcontrol.MotorEventQueue; import ve.ucv.ciens.ccg.nxtcam.robotcontrol.MotorEventQueue;
import ve.ucv.ciens.ccg.nxtcam.utils.Logger; import ve.ucv.ciens.ccg.nxtcam.utils.Logger;
public class LCPThread extends Thread{ public class NxtBTCommThread extends Thread{
private static final String TAG = "LCP_THREAD"; private static final String TAG = "LCP_THREAD";
private static final String CLASS_NAME = LCPThread.class.getSimpleName(); private static final String CLASS_NAME = NxtBTCommThread.class.getSimpleName();
private boolean done; private boolean done;
private boolean reportSensors;
private BTCommunicator btComm; private BTCommunicator btComm;
private MotorControlThread motorControl; private MotorControlThread motorControl;
private SensorReportThread sensorReport;
private MotorEventQueue queue; private MotorEventQueue queue;
public LCPThread(String serverIp){ public NxtBTCommThread(String serverIp){
super("Robot Control Main Thread"); super("Robot Control Main Thread");
btComm = BTCommunicator.getInstance(); btComm = BTCommunicator.getInstance();
done = false; done = false;
motorControl = new MotorControlThread(serverIp); motorControl = new MotorControlThread(serverIp);
sensorReport = new SensorReportThread(serverIp);
queue = MotorEventQueue.getInstance(); queue = MotorEventQueue.getInstance();
} }
@@ -49,7 +46,6 @@ public class LCPThread extends Thread{
MotorEvent event; MotorEvent event;
byte[] msg = new byte[2]; byte[] msg = new byte[2];
sensorReport.start();
motorControl.start(); motorControl.start();
then = System.currentTimeMillis(); then = System.currentTimeMillis();
@@ -63,21 +59,18 @@ public class LCPThread extends Thread{
} }
} }
if((reportSensors = sensorReport.isConnected())){
Logger.log_d(TAG, CLASS_NAME + ".run() :: Sensor data can be reported.");
}else{
Logger.log_e(TAG, CLASS_NAME + ".run() :: Thread sensorReport could not connect to the server.");
Logger.log_e(TAG, CLASS_NAME + ".run() :: Sensor data will not be reported to server app.");
}
while(!done){ while(!done){
if(btComm.isBTEnabled() && btComm.isConnected()){ if(btComm.isBTEnabled() && btComm.isConnected()){
msg[0] = 0x00;
msg[1] = 0x00;
event = queue.getNextEvent(); event = queue.getNextEvent();
try{ try{
// Set the motor bit. // Set the motor bit.
msg[0] = (event.getMotor() == motor_t.MOTOR_A) ? MotorMasks.MOTOR_A: ((event.getMotor() == motor_t.MOTOR_B) ? MotorMasks.MOTOR_B: MotorMasks.MOTOR_C); msg[0] |= (event.getMotor() == motor_t.MOTOR_A) ? MotorMasks.MOTOR_A : 0;
msg[0] |= (event.getMotor() == motor_t.MOTOR_B) ? MotorMasks.MOTOR_B : 0;
msg[0] |= (event.getMotor() == motor_t.MOTOR_C) ? MotorMasks.MOTOR_C : 0;
// Set the direction bit. // Set the direction bit.
if(event.getPower() > 0) msg[0] |= MotorMasks.DIRECTION; if(event.getPower() > 0) msg[0] |= MotorMasks.DIRECTION;
// TODO: Set the recenter bits. // TODO: Set the recenter bits.
@@ -94,10 +87,6 @@ public class LCPThread extends Thread{
}catch(IOException io){ }catch(IOException io){
Logger.log_e(TAG, CLASS_NAME + ".run() :: IOException sending message to the robot: " + io.getMessage()); Logger.log_e(TAG, CLASS_NAME + ".run() :: IOException sending message to the robot: " + io.getMessage());
} }
if(reportSensors){
}
}else{ }else{
Logger.log_e(TAG, CLASS_NAME + ".run() :: The robot disconnected or was never available."); Logger.log_e(TAG, CLASS_NAME + ".run() :: The robot disconnected or was never available.");
break; break;

View File

@@ -1,7 +1,7 @@
package ve.ucv.ciens.ccg.nxtcam.network; package ve.ucv.ciens.ccg.nxtcam.network;
import java.io.IOException; import java.io.IOException;
import java.io.ObjectOutputStream; import java.io.OutputStream;
import java.net.Socket; import java.net.Socket;
import ve.ucv.ciens.ccg.nxtcam.utils.Logger; import ve.ucv.ciens.ccg.nxtcam.utils.Logger;
@@ -14,21 +14,36 @@ public class SensorReportThread extends Thread{
private Socket socket; private Socket socket;
private String serverIp; private String serverIp;
private boolean done; private boolean done;
private ObjectOutputStream writer; private OutputStream writer;
private boolean connected; private boolean connected;
private BTCommunicator btComm;
public SensorReportThread(String serverIp){ public SensorReportThread(String serverIp){
super("Sensor Report Thread"); super("Sensor Report Thread");
this.serverIp = serverIp; this.serverIp = serverIp;
done = false; done = false;
connected = false; connected = false;
btComm = BTCommunicator.getInstance();
} }
@Override @Override
public void run(){ public void run(){
byte[] lightReading;
if(connectToServer()){ if(connectToServer()){
while(!done){ while(!done){
if(btComm.isBTEnabled() && btComm.isConnected()){
try{
lightReading = btComm.readMessage(1);
writer.write(lightReading);
}catch(IOException io){
Logger.log_e(TAG, CLASS_NAME + "run(): IOException: " + io.getMessage());
done = true;
}
}else{
Logger.log_e(TAG, CLASS_NAME + ".run() :: The robot disconnected or was never available.");
break;
}
} }
}else{ }else{
Logger.log_e(TAG, CLASS_NAME + ".run() :: Could not connect to the server."); Logger.log_e(TAG, CLASS_NAME + ".run() :: Could not connect to the server.");
@@ -43,7 +58,7 @@ public class SensorReportThread extends Thread{
boolean connected; boolean connected;
try{ try{
socket = new Socket(serverIp, ProjectConstants.SENSOR_REPORT_PORT); socket = new Socket(serverIp, ProjectConstants.SENSOR_REPORT_PORT);
writer = new ObjectOutputStream(socket.getOutputStream()); writer = socket.getOutputStream();
connected = true; connected = true;
}catch(IOException io){ }catch(IOException io){
Logger.log_e(TAG, CLASS_NAME + ".connectToServer() :: IOException caught: " + io.getMessage()); Logger.log_e(TAG, CLASS_NAME + ".connectToServer() :: IOException caught: " + io.getMessage());