Updated TODO List, Fixing UART CMD's & Parsing