No high cpu usage while idling in Emulator.

Emulator reads now blocking.

CubeControl/SerialHelper.java

 	private final short OK = 0x42;
 	private final short ERROR = 0x23;
 
+	// Timeout in milliseconds per byte
+	private final int transmitTimeout = 1000;
+	private final int recieveTimeout = 1000;
+
 	private Frame frame;
 
 	/**
 		SerialWriteThread t = new SerialWriteThread(data);
 		t.start();
 		while (!t.dataWasSent()) {
-			if ((new Date()).getTime() >= (startdate + (data.length * 1000))) {
-				// More than (length * 1000) milliseconds went by
-				// => 1 second per byte
+			if ((new Date()).getTime() >= (startdate + (data.length * transmitTimeout))) {
 				return false;
 			}
 		}
 	private short[] readData(int length) {
 		// return data read or null if timeout
 		long startdate = (new Date()).getTime();
-
+		short[] result;
 		SerialReadThread t = new SerialReadThread(length);
 		t.start();
 		while (!t.dataIsReady()) {
-			if ((new Date()).getTime() >= (startdate + (length * 1000))) {
-				// More than (length * 1000) milliseconds went by
-				// => 1 second per byte
+			if ((new Date()).getTime() >= (startdate + (length * recieveTimeout))) {
 				return null;
 			}
 		}
-		return t.getSerialData();
+		result = t.getSerialData();
+		if (result == null) {
+			System.out.println("Data read was null!");
+		} else if (result.length == 0) {
+			System.out.println("No data read!");
+		}
+		return result;
 	}
 }

HardwareEmulator/main.c

 
 volatile int keepRunning = 1;
 
+#define printf if(keepRunning)printf
+
 int main(int argc, char *argv[]) {
 	char c;
 	ssize_t size;
 }
 
 void intHandler(int dummy) {
-	keepRunning = 0;
 	printf("\nExiting...\n");
+	keepRunning = 0;
+	serialClose();
+	exit(0);
 }

HardwareEmulator/serial.c

 		return NULL;
 	}
 
-	fcntl(fd, F_SETFL, FNDELAY); // read non blocking
+	// fcntl(fd, F_SETFL, FNDELAY); // read non blocking
 	
 	tcgetattr(fd, &options);
 	cfsetispeed(&options, BAUD); // Set speed