Reading encoder to count steps(solved)