Robot moving function works fineadd