Improved robotLink.c message parsing