added set to current location and slow mode 100 times read and check +-2pi