Memory now working.

Also changed nitrate to highest one possible with our clock speed,
38400bps.

CubeControl/libSerial/unixSerial.c

 #include <dirent.h>
 #include <errno.h>
 
-#define BAUD B19200
+#define BAUD B38400
 
 int fd = -1;
 

CubeControl/libSerial/winSerial.c

 #include <stdio.h>
 #include <windows.h>
 
-#define BAUD CBR_19200;
+#define BAUD CBR_38400;
 
 HANDLE hSerial = INVALID_HANDLE_VALUE;
 

CubeFirmware/main.c

 	uint64_t lastChecked;
 
 	initCube();
-	serialInit(51, 8, NONE, 1);
+	serialInit(25, 8, NONE, 1);
 	i2c_init();
 	initSystemTimer();
 	sei(); // Enable Interrupts
 #ifdef DEBUG
 	refreshAnimationCount = 0; // Don't talk to FRAM yet...
 
-	serialWriteString("Initialized: ");
+	serialWriteString("\n\nInitialized: ");
 	serialWriteString(VERSION);
 	serialWriteString("Took ");
 	serialWriteString(itoa(getSystemTime(), buffer, 10));
 #ifdef DEBUG
 		serialWriteString("(t)ime, (a)udio, (c)ount, (x)Custom count\n");
 		serialWriteString("(y)Set fixed animation count\n");
+		serialWriteString("S(e)lf Test\n");
 #endif
 		break;
 
 		setAnimationCount(0x2201);
 		serialWriteString("Animation count now 8705!\n");
 		break;
+
+	case 'e': case 'E':
+		c = selfTest();
+		serialWriteString("Self-Test: 0b");
+		serialWriteString(itoa(c, buffer, 2));
+		serialWrite('\n');
+		printErrors(c);
+		break;
 #endif
 
 	default:

CubeFirmware/mem.c

 		// Address needs more than 16 bits, we have to set the PAGE bit in i2c address
 		memAddress |= 2;
 	}
-	addA = memAddress & 0xFF00;
-	addB = memAddress & 0xFF;
+	addA = address & 0xFF00;
+	addB = address & 0xFF;
 
 	if (i2c_start(memAddress | I2C_WRITE) == 0) { // Send start, write address to read
 		i2c_write(addA);
 		// Address needs more than 16 bits, we have to set the PAGE bit in i2c address
 		memAddress |= 2;
 	}
-	addA = memAddress & 0xFF00;
-	addB = memAddress & 0xFF;
+	addA = address & 0xFF00;
+	addB = address & 0xFF;
 	ret = (uint8_t *)malloc(length); // Allocate memory for values read
 	if (ret == NULL) {
 #ifdef DEBUG
 		// Address needs more than 16 bits, we have to set the PAGE bit in i2c address
 		memAddress |= 2;
 	}
-	addA = memAddress & 0xFF00;
-	addB = memAddress & 0xFF;
+	addA = address & 0xFF00;
+	addB = address & 0xFF;
 	if (i2c_start(memAddress | I2C_WRITE) == 0) {
 		i2c_write(addA);
 		i2c_write(addB); // Give address to memory
 		// Address needs more than 16 bits, we have to set the PAGE bit in i2c address
 		memAddress |= 2;
 	}
-	addA = memAddress & 0xFF00;
-	addB = memAddress & 0xFF;
+	addA = address & 0xFF00;
+	addB = address & 0xFF;
 	if (i2c_start(memAddress | I2C_WRITE) == 0) {
 		i2c_write(addA);
 		i2c_write(addB); // Give address to memory