Chaned the PMSM.c file to work with Motor 7
Hopefully this will work on the other motors?