pmsm control永磁同步电机的有传感器控制主程序