Fixing problem on motor Control