Some fixes after debugging on robot