SynRel motor design - Pure SynRel control algorytm