 		// Write back error
 		sprintf(i2c_buff, "ERROR\n", SonarReading[0]);
 	}
+	i2c_buffer_ready = 0; // Mark Arduino as ready
+	i2c_buffer_len = strlen(i2c_buff);
+
 	return;
 }
	}

	// Parse Request
	if(buff[0] == 's' && numBytes >= 2){
		// Read sonar id
		int sonar;

}

void I2C_Request(){
	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;
}

