Program for stepper test.
Dependencies: StepperDriver mbed
main.cpp
- Committer:
- tbjazic
- Date:
- 2016-12-02
- Revision:
- 2:702fd272a9c8
- Parent:
- 1:5d11b66aba85
File content as of revision 2:702fd272a9c8:
#include "mbed.h" #include "StepperDriver.h" StepperDriver stepper(p26, p29); DigitalOut CDENBLN(p17); DigitalOut CDUSM1(p16); DigitalOut CDUSM0(p28); DigitalOut CDRESETn(p15); DigitalOut DECAY(p18); float t = 0, period = 2; int main() { CDENBLN = 0; //Logicka 0 ukljucuje elektromotor, 1 iskljucuje CDUSM1 = 0; // 1/8 micro step mode ==1, full step mode == 0 CDUSM0 = 0; // 1/8 micro step mode ==1, full step mode == 0 CDRESETn = 1; //Logicka 0 ukljucuje indekser ali gasi H-most DECAY = 0; //Logicka 0 slow decay, 1 za mixed decay stepper.setPosition(720); wait(2); while(t < 10*period) { stepper.setPosition(720+360*sin(2*3.14159f/period*t)); t += 0.05; wait(0.05); } stepper.setPosition(0); CDENBLN = 1; }