Field Oriented Control (FOC)

Let's build FOC libraries with me, this library is build from 'DengFOC' and 'SimpleFOC' libraries.