Added Logging to the Robot and Message Router
Fix for index out of range exception
Merge pull request #34 from JonathanStarnes/master

Logging and fixes for index out of range exception