working mode 0 based on encoders
trying with feedback error