The realize arithmetics of main modules only are put forward.

• 尚未与电流环和速度环集成到单片FPGA中，在此仅提出主要模块的实现算法。