added working base source code + TEST_ROBOT.m