FOC控制算法