Du schaltest in der Endlosschleife in Main() den Motor ständig an und aus, so bekommt der keinen Strom.

Lass mal in MotorSpeed das aus und anschalten des Motors weg, dann sollte es klappen. Ist ohnehin nicht nötig, da die neuen PWM Werte erst beim nächsten PWM Zyklus übernommen werden.