now robot works but i need to debug position and fix sharp after