Fixed latch selection

Code never was rewritten for new Hardware.

CubeFirmware/cube.c

@@ -126,9 +126,15 @@ inline void setFet(uint8_t data) {
 
 // Give id of latch, 0 - 7
 inline void selectLatch(uint8_t latchNr) {
-	PORTC = 0;
-	if (latchNr < 8) {
-		PORTC = 1 << latchNr;
+	// Disable all latches
+	PORTC &= ~(0xFC); // 2 - 7
+	PORTB &= ~(6); // 0 & 1
+
+	// Enable desired latch
+	if (latchNr > 1) {
+		PORTC |= (1 << latchNr);
+	} else {
+		PORTB |= (1 << (latchNr + 1));
 	}
 }
 

CubeFirmware/main.c

@@ -112,10 +112,10 @@ int main(void) {
 
 	wdt_enable(WDTO_500MS); // Enable watchdog reset after 500ms
 
-	DDRD = 0xFC; // Mosfets as Output
-	DDRB = 0xFE;
-	DDRC = 0xFF; // Latch Enable
-	DDRA = 0xFF; // Latch Data
+	DDRA = 0xFF; // Latch Data Bus as Output
+	DDRD = 0xFC; DDRB = 24; // Mosfets as Output
+	DDRC = 0xFC; DDRB |= 6; // Latch Enable as Output
+	DDRB &= ~(1 << PB0); // Pushbutton as Input
 
 	setImage(defaultImage); // Display something