intentomotorpasoapaso

Dependencies:   mbed

Fork of 00_LAB_STEPMOTOR by ferney alberto beltran molina

main.cpp

Committer:
ANTONIO_VARGAS
Date:
2018-04-11
Revision:
2:1f5d8504b38d
Parent:
1:5dfedc044f7a

File content as of revision 2:1f5d8504b38d:

#include "mbed.h"
#include "stepmotor.h"

#define NSXC 4096
stepmotor smotor1(D9,D10,D11,D12);
Serial pc(USBTX,USBRX);
int main() {
    
    //definir posicion central del servo
    
    
    
    uint32_t speed=1500;
    bool cw=true;
    
    while(1)
    {
        smotor1.set_speed(speed);
       

        pc.printf("velocidad del motor:  %i, %f rpm, CW=%d  \n",smotor1.get_speed(), (60/((smotor1.get_speed()*4.096)/1000))cw);
        
        smotor1.step(cu*NSXC,sent);
        
       
        speed=speed+1000;
        if (speed > 9600)speed =1500;
        cw=!cw;
        wait(1);
    }
}