Hi, @Antun_Skuric
It Works!! 
just removing the resistance, and it spins smoothly in open loop up to 17 rad/sec and closed loop voltage control also now works.
I wish to work towards implementing the FOC current torque control mode. How do you recommend moving over to current control?
1 Like
Awesome 
For starting with the foc, I’d suggest you to start with the simplefocshield’s example in the library examples (hardware specific) and then use the awesome app SimpleFOCStudio to tune the parameters of the current PIDs. Once you’re happy with the results you can generate the code for the parameters and copy paste them to your code.