Code Cleanup
Added Serial Communications

Still need to change to send and receive via SERIAL1 etc