[LibRobotCampus] Adding flush command
[LibRobotCampus] Echo mode and register checks
[src] Adding basic main