Replaced heartbeat lock with synchronized methods
It still works...
Added send & read methods to CommandHandler
RRCPCommandHandler executeCommand switch with be replaced by else if statements because robot Java does not support
Merge branch 'master' of https://github.com/orangelight/Robostangs-Robot-Communication-Protocol