Javier Duarte
/
Motor_bip_pot_var
motor bipolar pot variable
main.cpp@0:12f726c816f0, 2019-11-19 (annotated)
- Committer:
- Javierdf
- Date:
- Tue Nov 19 05:11:08 2019 +0000
- Revision:
- 0:12f726c816f0
motor bipolar pot var
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
Javierdf | 0:12f726c816f0 | 1 | // programa lectura de pin analogico infinito, para mover motor bipolar, en ambos sentidos |
Javierdf | 0:12f726c816f0 | 2 | #include "mbed.h" |
Javierdf | 0:12f726c816f0 | 3 | |
Javierdf | 0:12f726c816f0 | 4 | BusOut M1(D2,D3,D4,D5); |
Javierdf | 0:12f726c816f0 | 5 | char pos1[4]={0x05,0x06,0x0A,0x09}; |
Javierdf | 0:12f726c816f0 | 6 | char pos2[4]={0x0A,0x06,0x05,0x09}; |
Javierdf | 0:12f726c816f0 | 7 | int i=0,u=0; |
Javierdf | 0:12f726c816f0 | 8 | AnalogIn a1(A5); |
Javierdf | 0:12f726c816f0 | 9 | |
Javierdf | 0:12f726c816f0 | 10 | |
Javierdf | 0:12f726c816f0 | 11 | int main() |
Javierdf | 0:12f726c816f0 | 12 | { |
Javierdf | 0:12f726c816f0 | 13 | |
Javierdf | 0:12f726c816f0 | 14 | int x=0; |
Javierdf | 0:12f726c816f0 | 15 | int y=0; |
Javierdf | 0:12f726c816f0 | 16 | int v=0; |
Javierdf | 0:12f726c816f0 | 17 | |
Javierdf | 0:12f726c816f0 | 18 | |
Javierdf | 0:12f726c816f0 | 19 | while(1){ |
Javierdf | 0:12f726c816f0 | 20 | |
Javierdf | 0:12f726c816f0 | 21 | |
Javierdf | 0:12f726c816f0 | 22 | y=200*a1.read(); |
Javierdf | 0:12f726c816f0 | 23 | wait(0.05); |
Javierdf | 0:12f726c816f0 | 24 | if(x<y) |
Javierdf | 0:12f726c816f0 | 25 | { |
Javierdf | 0:12f726c816f0 | 26 | for(x=v;x<y;x++) |
Javierdf | 0:12f726c816f0 | 27 | { |
Javierdf | 0:12f726c816f0 | 28 | y=200*a1.read(); |
Javierdf | 0:12f726c816f0 | 29 | wait(0.02); |
Javierdf | 0:12f726c816f0 | 30 | M1=pos1[i]; |
Javierdf | 0:12f726c816f0 | 31 | wait(0.01); |
Javierdf | 0:12f726c816f0 | 32 | i++; |
Javierdf | 0:12f726c816f0 | 33 | if(i==4) |
Javierdf | 0:12f726c816f0 | 34 | i=0; |
Javierdf | 0:12f726c816f0 | 35 | } |
Javierdf | 0:12f726c816f0 | 36 | v=x; |
Javierdf | 0:12f726c816f0 | 37 | } |
Javierdf | 0:12f726c816f0 | 38 | wait(0.01); |
Javierdf | 0:12f726c816f0 | 39 | if(x>y) |
Javierdf | 0:12f726c816f0 | 40 | { |
Javierdf | 0:12f726c816f0 | 41 | for(x=v;x>y;x--) |
Javierdf | 0:12f726c816f0 | 42 | { |
Javierdf | 0:12f726c816f0 | 43 | y=200*a1.read(); |
Javierdf | 0:12f726c816f0 | 44 | wait(0.02); |
Javierdf | 0:12f726c816f0 | 45 | M1=pos2[u]; |
Javierdf | 0:12f726c816f0 | 46 | wait(0.01); |
Javierdf | 0:12f726c816f0 | 47 | u++; |
Javierdf | 0:12f726c816f0 | 48 | if(u==4) |
Javierdf | 0:12f726c816f0 | 49 | u=0; |
Javierdf | 0:12f726c816f0 | 50 | } |
Javierdf | 0:12f726c816f0 | 51 | v=x; |
Javierdf | 0:12f726c816f0 | 52 | } |
Javierdf | 0:12f726c816f0 | 53 | } |
Javierdf | 0:12f726c816f0 | 54 | } |