Added echo functionality to parse_packet(). Sends back the message ID upon receiving a message.

.metadata/.plugins/org.eclipse.core.runtime/.settings/org.eclipse.cdt.core.prj-modular_quad_pid.prefs

-eclipse.preferences.version=1
-indexer/preferenceScope=0
-language.settings.providers.disabled=false

.metadata/.plugins/org.eclipse.core.runtime/.settings/org.eclipse.cdt.core.prj-system_bsp.prefs

-eclipse.preferences.version=1
-indexer/preferenceScope=0
-language.settings.providers.disabled=false

.metadata/.plugins/org.eclipse.core.runtime/.settings/org.eclipse.cdt.debug.core.prefs

-eclipse.preferences.version=1
-org.eclipse.cdt.debug.core.cDebug.default_source_containers=<?xml version\="1.0" encoding\="UTF-8" standalone\="no"?>\n<sourceLookupDirector>\n<sourceContainers duplicates\="false">\n<container memento\="AbsolutePath" typeId\="org.eclipse.cdt.debug.core.containerType.absolutePath"/>\n<container memento\="programRelativePath" typeId\="org.eclipse.cdt.debug.core.containerType.programRelativePath"/>\n<container memento\="&lt;?xml version\=&quot;1.0&quot; encoding\=&quot;UTF-8&quot; standalone\=&quot;no&quot;?&gt;&\#10;&lt;project referencedProjects\=&quot;true&quot;/&gt;&\#10;" typeId\="org.eclipse.cdt.debug.core.containerType.project"/>\n</sourceContainers>\n</sourceLookupDirector>\n

.metadata/.plugins/org.eclipse.core.runtime/.settings/org.eclipse.cdt.managedbuilder.core.prefs

-eclipse.preferences.version=1
-properties/modular_quad_pid.xilinx.gnu.arm.exe.832182557/xilinx.gnu.arm.exe.debug.980189137=\#\n\#Sun Oct 16 19\:49\:48 CDT 2016\nxilinx.gnu.arm.c.toolchain.compiler.debug.177835003\=\\\#\\n\\\#Sun Oct 16 19\\\:49\\\:48 CDT 2016\\nrebuildState\\\=false\\n\nxilinx.gnu.arm.c.toolchain.assembler.debug.192056667\=\\\#\\n\\\#Sun Oct 16 19\\\:49\\\:48 CDT 2016\\nrebuildState\\\=false\\n\nxilinx.gnu.arm.cxx.toolchain.linker.debug.1921379343\=\\\#\\n\\\#Sun Oct 16 19\\\:49\\\:48 CDT 2016\\nrebuildState\\\=false\\n\nxilinx.gnu.arm.exe.debug.980189137\=\\\#\\n\\\#Sun Oct 16 19\\\:48\\\:28 CDT 2016\\nrcState\\\=0\\nrebuildState\\\=false\\n\nxilinx.gnu.arm.exe.debug.toolchain.1195127676\=\\\#\\n\\\#Sun Oct 16 19\\\:49\\\:48 CDT 2016\\nrebuildState\\\=false\\n\nxilinx.gnu.arm.size.debug.923967150\=\\\#\\n\\\#Sun Oct 16 19\\\:49\\\:48 CDT 2016\\nrebuildState\\\=false\\n\nxilinx.gnu.arm.c.toolchain.linker.debug.360488201\=\\\#\\n\\\#Sun Oct 16 19\\\:49\\\:48 CDT 2016\\nrebuildState\\\=false\\n\nxilinx.gnu.arm.toolchain.archiver.585254344\=\\\#\\n\\\#Sun Oct 16 19\\\:49\\\:48 CDT 2016\\nrebuildState\\\=false\\n\nxilinx.gnu.arm.cxx.toolchain.compiler.debug.1470236349\=\\\#\\n\\\#Sun Oct 16 19\\\:49\\\:48 CDT 2016\\nrebuildState\\\=false\\n\n
-properties/modular_quad_pid.xilinx.gnu.arm.exe.832182557/xilinx.gnu.arm.exe.release.255973624=\#\n\#Sun Oct 16 19\:49\:48 CDT 2016\nxilinx.gnu.arm.cxx.toolchain.linker.release.1512126497\=\\\#\\n\\\#Sun Oct 16 19\\\:49\\\:48 CDT 2016\\nrebuildState\\\=true\\n\nxilinx.gnu.arm.exe.release.toolchain.1375808537\=\\\#\\n\\\#Sun Oct 16 19\\\:49\\\:48 CDT 2016\\nrebuildState\\\=true\\n\nxilinx.gnu.arm.toolchain.archiver.86822110\=\\\#\\n\\\#Sun Oct 16 19\\\:49\\\:48 CDT 2016\\nrebuildState\\\=true\\n\nxilinx.gnu.arm.c.toolchain.assembler.release.1899854338\=\\\#\\n\\\#Sun Oct 16 19\\\:49\\\:48 CDT 2016\\nrebuildState\\\=true\\n\nxilinx.gnu.arm.cxx.toolchain.compiler.release.1846278293\=\\\#\\n\\\#Sun Oct 16 19\\\:49\\\:48 CDT 2016\\nrebuildState\\\=true\\n\nxilinx.gnu.arm.c.toolchain.linker.release.264708896\=\\\#\\n\\\#Sun Oct 16 19\\\:49\\\:48 CDT 2016\\nrebuildState\\\=true\\n\nxilinx.gnu.arm.c.toolchain.compiler.release.85270120\=\\\#\\n\\\#Sun Oct 16 19\\\:49\\\:48 CDT 2016\\nrebuildState\\\=true\\n\nxilinx.gnu.arm.size.release.362029751\=\\\#\\n\\\#Sun Oct 16 19\\\:49\\\:48 CDT 2016\\nrebuildState\\\=true\\n\n

.metadata/.plugins/org.eclipse.core.runtime/.settings/org.eclipse.core.resources.prefs

-eclipse.preferences.version=1
-version=1

.metadata/.plugins/org.eclipse.core.runtime/.settings/org.eclipse.debug.core.prefs

-//org.eclipse.debug.core.PREFERRED_DELEGATES/org.eclipse.cdt.launch.applicationLaunchType=org.eclipse.cdt.dsf.gdb.launch.localCLaunch,debug;org.eclipse.cdt.cdi.launch.localCLaunch,run
-//org.eclipse.debug.core.PREFERRED_DELEGATES/org.eclipse.cdt.launch.attachLaunchType=org.eclipse.cdt.dsf.gdb.launch.attachCLaunch,debug
-//org.eclipse.debug.core.PREFERRED_DELEGATES/org.eclipse.cdt.launch.postmortemLaunchType=org.eclipse.cdt.dsf.gdb.launch.coreCLaunch,debug
-//org.eclipse.debug.core.PREFERRED_DELEGATES/org.eclipse.cdt.launch.remoteApplicationLaunchType=org.eclipse.rse.remotecdt.dsf.debug,debug
-eclipse.preferences.version=1

.metadata/.plugins/org.eclipse.core.runtime/.settings/org.eclipse.ui.prefs

-eclipse.preferences.version=1
-showIntro=false

.metadata/.plugins/org.eclipse.ui.workbench/workingsets.xml

-<?xml version="1.0" encoding="UTF-8"?>
-<workingSetManager>
-<workingSet aggregate="true" factoryID="org.eclipse.ui.internal.WorkingSetFactory" id="1476664817124_0" label="Window Working Set" name="Aggregate for window 1476664817123"/>
-</workingSetManager>
\ No newline at end of file

.metadata/version.ini

-org.eclipse.core.runtime=1
\ No newline at end of file

modular_quad_pid/Debug/modular_quad_pid.elf.size

    text	   data	    bss	    dec	    hex	filename
- 156328	  67312	119149912	119373552	71d7ef0	modular_quad_pid.elf
+ 156504	  67312	119149912	119373728	71d7fa0	modular_quad_pid.elf

modular_quad_pid/Debug/src/communication.d

 src/communication.d: ../src/communication.c ../src/communication.h \
- ../src/commands.h ../src/type_def.h
+ ../src/commands.h ../src/type_def.h ../src/uart.h \
+ ../../system_bsp/ps7_cortexa9_0/include/xparameters.h \
+ ../../system_bsp/ps7_cortexa9_0/include/xparameters_ps.h \
+ ../../system_bsp/ps7_cortexa9_0/include/xuartps.h \
+ ../../system_bsp/ps7_cortexa9_0/include/xil_types.h \
+ ../../system_bsp/ps7_cortexa9_0/include/xil_assert.h \
+ ../../system_bsp/ps7_cortexa9_0/include/xstatus.h \
+ ../../system_bsp/ps7_cortexa9_0/include/xuartps_hw.h \
+ ../../system_bsp/ps7_cortexa9_0/include/xil_io.h \
+ ../../system_bsp/ps7_cortexa9_0/include/xpseudo_asm.h \
+ ../../system_bsp/ps7_cortexa9_0/include/xreg_cortexa9.h \
+ ../../system_bsp/ps7_cortexa9_0/include/xpseudo_asm_gcc.h \
+ ../../system_bsp/ps7_cortexa9_0/include/xil_printf.h \
+ ../../system_bsp/ps7_cortexa9_0/include/xparameters.h \
+ ../src/stringBuilder.h
 
 ../src/communication.h:
 
 ../src/commands.h:
 
 ../src/type_def.h:
+
+../src/uart.h:
+
+../../system_bsp/ps7_cortexa9_0/include/xparameters.h:
+
+../../system_bsp/ps7_cortexa9_0/include/xparameters_ps.h:
+
+../../system_bsp/ps7_cortexa9_0/include/xuartps.h:
+
+../../system_bsp/ps7_cortexa9_0/include/xil_types.h:
+
+../../system_bsp/ps7_cortexa9_0/include/xil_assert.h:
+
+../../system_bsp/ps7_cortexa9_0/include/xstatus.h:
+
+../../system_bsp/ps7_cortexa9_0/include/xuartps_hw.h:
+
+../../system_bsp/ps7_cortexa9_0/include/xil_io.h:
+
+../../system_bsp/ps7_cortexa9_0/include/xpseudo_asm.h:
+
+../../system_bsp/ps7_cortexa9_0/include/xreg_cortexa9.h:
+
+../../system_bsp/ps7_cortexa9_0/include/xpseudo_asm_gcc.h:
+
+../../system_bsp/ps7_cortexa9_0/include/xil_printf.h:
+
+../../system_bsp/ps7_cortexa9_0/include/xparameters.h:
+
+../src/stringBuilder.h: