kbot_bridge: Implemented sonar message parsing