motor bipolar ctrl visual st
Dependencies: mbed
main.cpp@0:019a33f5a47c, 2019-11-19 (annotated)
- Committer:
- Javierdf
- Date:
- Tue Nov 19 05:05:57 2019 +0000
- Revision:
- 0:019a33f5a47c
motor bipolar visual
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
Javierdf | 0:019a33f5a47c | 1 | #include "mbed.h" |
Javierdf | 0:019a33f5a47c | 2 | |
Javierdf | 0:019a33f5a47c | 3 | BusOut M1(D2,D3,D4,D5); |
Javierdf | 0:019a33f5a47c | 4 | Serial pc(USBTX, USBRX); |
Javierdf | 0:019a33f5a47c | 5 | char pos1[4]={0x05,0x06,0x0A,0x09}; |
Javierdf | 0:019a33f5a47c | 6 | char pos2[4]={0x0A,0x06,0x05,0x09}; |
Javierdf | 0:019a33f5a47c | 7 | int i=0,u=0; |
Javierdf | 0:019a33f5a47c | 8 | |
Javierdf | 0:019a33f5a47c | 9 | int main() |
Javierdf | 0:019a33f5a47c | 10 | { |
Javierdf | 0:019a33f5a47c | 11 | |
Javierdf | 0:019a33f5a47c | 12 | int x=0; |
Javierdf | 0:019a33f5a47c | 13 | int y=0; |
Javierdf | 0:019a33f5a47c | 14 | int v=0; |
Javierdf | 0:019a33f5a47c | 15 | |
Javierdf | 0:019a33f5a47c | 16 | while(1){ |
Javierdf | 0:019a33f5a47c | 17 | |
Javierdf | 0:019a33f5a47c | 18 | y=pc.getc(); |
Javierdf | 0:019a33f5a47c | 19 | |
Javierdf | 0:019a33f5a47c | 20 | if(x<=y) |
Javierdf | 0:019a33f5a47c | 21 | { |
Javierdf | 0:019a33f5a47c | 22 | for(x=v;x<=y;x++) |
Javierdf | 0:019a33f5a47c | 23 | { |
Javierdf | 0:019a33f5a47c | 24 | y=pc.getc(); |
Javierdf | 0:019a33f5a47c | 25 | |
Javierdf | 0:019a33f5a47c | 26 | M1=pos1[i]; |
Javierdf | 0:019a33f5a47c | 27 | wait(0.005); |
Javierdf | 0:019a33f5a47c | 28 | i++; |
Javierdf | 0:019a33f5a47c | 29 | if(i==4) |
Javierdf | 0:019a33f5a47c | 30 | i=0; |
Javierdf | 0:019a33f5a47c | 31 | } |
Javierdf | 0:019a33f5a47c | 32 | v=x; |
Javierdf | 0:019a33f5a47c | 33 | } |
Javierdf | 0:019a33f5a47c | 34 | |
Javierdf | 0:019a33f5a47c | 35 | if(x>=y) |
Javierdf | 0:019a33f5a47c | 36 | { |
Javierdf | 0:019a33f5a47c | 37 | for(x=v;x>=y;x--) |
Javierdf | 0:019a33f5a47c | 38 | { |
Javierdf | 0:019a33f5a47c | 39 | y=pc.getc(); |
Javierdf | 0:019a33f5a47c | 40 | |
Javierdf | 0:019a33f5a47c | 41 | M1=pos2[u]; |
Javierdf | 0:019a33f5a47c | 42 | wait(0.005); |
Javierdf | 0:019a33f5a47c | 43 | u++; |
Javierdf | 0:019a33f5a47c | 44 | if(u==4) |
Javierdf | 0:019a33f5a47c | 45 | u=0; |
Javierdf | 0:019a33f5a47c | 46 | } |
Javierdf | 0:019a33f5a47c | 47 | v=x; |
Javierdf | 0:019a33f5a47c | 48 | } |
Javierdf | 0:019a33f5a47c | 49 | } |
Javierdf | 0:019a33f5a47c | 50 | } |