Dagozilla to RoboCup
/
StepperTB_Example
Tester program buat StepperTB
Diff: main.cpp
- Revision:
- 0:b18783e04c0e
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/main.cpp Fri Nov 09 17:30:34 2018 +0000 @@ -0,0 +1,38 @@ +#include "mbed.h" +#include "StepperTB.h" + +int StepPerRev = 200; +int DelayAntarMode = 2; +int const DelayStepperUs = 100; +int Microstep = 32; + +PinName ENA_ = PH_1; +PinName DIR_ = PB_0; +PinName PUL_ = PC_1; + +//Membuat instance object Stepper +//ENA - DIR - PUL +StepperTB stepperqu(ENA_, DIR_, PUL_, Microstep, StepPerRev); + +int main(){ + + while(1){ + //Gerakkan stepper 100 step CCW dengan delay antar microstep DelayStepperUs + stepperqu.MoveStep(-100, DelayStepperUs); + //wait(DelayAntarMode); + + //Gerakkan stepper 100 step CW dengan delay antar microstep DelayStepperUs + stepperqu.MoveStep(100, DelayStepperUs); + wait(DelayAntarMode); + + /* + //Gerakkan stepper 1 putaran CCW dengan delay antar microstep DelayStepperUs + stepperqu.MoveRev(1, DelayStepperUs); + wait(DelayAntarMode); + + //Gerakkan stepper 1 putaran CW dengan delay antar microstep DelayStepperUs + stepperqu.MoveRev(-1, DelayStepperUs); + wait(DelayAntarMode); + */ + } + } \ No newline at end of file