S-01040 Motion control, step 2: 1. fixed a buf related to inverted pwm polarity; 2. finilized a framework for the vertical motion control algorithm; 3. implemented a basic pwm test (with LEDs); 4. modified some default values.