Did some checks with real robot