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;
}