diff --git a/quad/sw/modular_quad_pid/src/communication.c b/quad/sw/modular_quad_pid/src/communication.c
index c669261cc01f5a8cb91467a9ba72a88a998c4606..bc8a1df4371f38e128f386328ef533000586a90b 100644
--- a/quad/sw/modular_quad_pid/src/communication.c
+++ b/quad/sw/modular_quad_pid/src/communication.c
@@ -224,11 +224,11 @@ int send_data(u16 type_id, u16 subtype_id, u16 msg_id, char* data, size_t size)
 	// Compute checksum while sending
 	unsigned char packet_checksum = 0;
 
-	//int i;
+	int i;
 	// TODO: Look into uart0_sendBytes and see if it would be better to use
 	// Send header
-	uart0_sendBytes(formattedHeader, 7);
-	/*
+	//uart0_sendBytes(formattedHeader, 7);
+
 	for(i = 0; i < 7; i++) {
 		packet_checksum ^= formattedHeader[i];
 		uart0_sendByte(formattedHeader[i]);
@@ -237,9 +237,8 @@ int send_data(u16 type_id, u16 subtype_id, u16 msg_id, char* data, size_t size)
 	for (i = 0; i < size; i++) {
 		packet_checksum ^= data[i];
 		uart0_sendByte(data[i]);
-	}*/
-	// Send data
-	uart0_sendBytes(data, size);
+	}
+	//uart0_sendBytes(data, size);
 	// Send checksum
 	uart0_sendByte(packet_checksum);