Motors pins changed.

P9_16 was giving problems when generating the PWM signal.
It was moved to P9_21 and this one to P9_42.