diff --git a/software/code/main.c b/software/code/main.c
index 8dac712f01224e38d862645857b754f7342ee9a8..e34c74bb8427c89ca60a198bcc218266af0b86fb 100644
--- a/software/code/main.c
+++ b/software/code/main.c
@@ -48,9 +48,9 @@ void write_out_3(uint32_t value_3) {
 }
 void set_out_invalid(void) {
 	
-  OUT_REGS[3] = 0;
+  OUT_REGS[6] = 0;
+  OUT_REGS[4] = 0;
   OUT_REGS[2] = 0;
-  OUT_REGS[1] = 0;
   OUT_REGS[0] = 0;
 
 }
@@ -58,9 +58,9 @@ void set_out_invalid(void) {
 uint32_t read_out(void) {
 
   return OUT_REGS[0];
-  return OUT_REGS[1];
   return OUT_REGS[2];
-  return OUT_REGS[3];  
+  return OUT_REGS[4];
+  return OUT_REGS[6];  
 }
 
 uint32_t read_switches(int addr) {