Dspic30f4011 DC motor control program