edson antonio vargas villarreal
/
LAB_STEPMOTOR
intentomotorpasoapaso
Fork of 00_LAB_STEPMOTOR by
main.cpp@2:1f5d8504b38d, 2018-04-11 (annotated)
- Committer:
- ANTONIO_VARGAS
- Date:
- Wed Apr 11 00:52:00 2018 +0000
- Revision:
- 2:1f5d8504b38d
- Parent:
- 1:5dfedc044f7a
hhjh
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
fabeltranm | 0:2890f9a09e85 | 1 | #include "mbed.h" |
fabeltranm | 0:2890f9a09e85 | 2 | #include "stepmotor.h" |
fabeltranm | 0:2890f9a09e85 | 3 | |
ANTONIO_VARGAS | 2:1f5d8504b38d | 4 | #define NSXC 4096 |
fabeltranm | 0:2890f9a09e85 | 5 | stepmotor smotor1(D9,D10,D11,D12); |
fabeltranm | 0:2890f9a09e85 | 6 | Serial pc(USBTX,USBRX); |
fabeltranm | 0:2890f9a09e85 | 7 | int main() { |
ANTONIO_VARGAS | 2:1f5d8504b38d | 8 | |
ANTONIO_VARGAS | 2:1f5d8504b38d | 9 | //definir posicion central del servo |
ANTONIO_VARGAS | 2:1f5d8504b38d | 10 | |
ANTONIO_VARGAS | 2:1f5d8504b38d | 11 | |
ANTONIO_VARGAS | 2:1f5d8504b38d | 12 | |
fabeltranm | 0:2890f9a09e85 | 13 | uint32_t speed=1500; |
fabeltranm | 1:5dfedc044f7a | 14 | bool cw=true; |
ANTONIO_VARGAS | 2:1f5d8504b38d | 15 | |
fabeltranm | 0:2890f9a09e85 | 16 | while(1) |
fabeltranm | 0:2890f9a09e85 | 17 | { |
fabeltranm | 0:2890f9a09e85 | 18 | smotor1.set_speed(speed); |
fabeltranm | 0:2890f9a09e85 | 19 | |
fabeltranm | 0:2890f9a09e85 | 20 | |
ANTONIO_VARGAS | 2:1f5d8504b38d | 21 | pc.printf("velocidad del motor: %i, %f rpm, CW=%d \n",smotor1.get_speed(), (60/((smotor1.get_speed()*4.096)/1000))cw); |
fabeltranm | 0:2890f9a09e85 | 22 | |
ANTONIO_VARGAS | 2:1f5d8504b38d | 23 | smotor1.step(cu*NSXC,sent); |
fabeltranm | 0:2890f9a09e85 | 24 | |
ANTONIO_VARGAS | 2:1f5d8504b38d | 25 | |
ANTONIO_VARGAS | 2:1f5d8504b38d | 26 | speed=speed+1000; |
ANTONIO_VARGAS | 2:1f5d8504b38d | 27 | if (speed > 9600)speed =1500; |
ANTONIO_VARGAS | 2:1f5d8504b38d | 28 | cw=!cw; |
fabeltranm | 0:2890f9a09e85 | 29 | wait(1); |
fabeltranm | 0:2890f9a09e85 | 30 | } |
fabeltranm | 0:2890f9a09e85 | 31 | } |