算法输入 1)位置反馈 2)ADC电流采样 算法处理 1)FOC控制算法 相位对齐 Clark变换 Park变换 Park逆变换 2)PID控制算法 位置PID 速度PID Iq PID Id PID 算法输出 1)PWM驱动