 }
 
 void I2C_Request(){
-	Wire.write(i2c_buff);
+	if(i2c_buffer_ready >= 0 && i2c_buffer_ready < i2c_buffer_len){
+		// Write next char
+		Wire.write(i2c_buff[i2c_buffer_ready]);
+		Serial.print(i2c_buff[i2c_buffer_ready]);
+		Serial.print("\n");
+		i2c_buffer_ready++;
+	} else if (i2c_buffer_ready >= i2c_buffer_len){
+		// Reset Counter
+		i2c_buffer_ready = -1;
+	}
 	return;
 }
 

//Comment out to disable serial debugging
#define debugOn

// Sonar ISR
#include "sonarInterupt.h"
void SetupSonar(void);

	}

	// Parse Request
	i2c_buffer_ready = -1; // Mark Arduino as busy
	if(buff[0] == 's' && numBytes >= 2){
		// Read sonar id
		int sonar;
