BEMF control of legs now works on IP2.5