TVZ Mechatronics Team / Mbed 2 deprecated StepperTest

Program for stepper test.

Dependencies:   StepperDriver mbed

main.cpp

Committer:
mcmrk
Date:
2016-12-01
Revision:
1:5d11b66aba85
Parent:
0:98715b9719a6
Child:
2:702fd272a9c8

File content as of revision 1:5d11b66aba85:

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

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(322);
    wait(2);
    while(true) {
        stepper.setPosition(322+175*sin(2*3.14159*1*t));
        t += 0.05;
        wait(0.05);
    }
}