start improving motion control (not working yet)