Communication working flawlessly :D

Debugged the encoding function, it's becoming a bit of a spaghetti...