PIC32 Multimotor PID controller