BEMF control of legs now working on IP2.5