lorzangas porafor
/
motorpaso
control simple de motor paso a paso unipolar
main.cpp@2:42e4a5fcc99f, 2012-10-22 (annotated)
- Committer:
- lorzangas
- Date:
- Mon Oct 22 05:03:04 2012 +0000
- Revision:
- 2:42e4a5fcc99f
- Parent:
- 1:26c2fd1ea036
simple control motor paso a paso unipolar
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
lorzangas | 0:414bd7c6b901 | 1 | #include "mbed.h" |
lorzangas | 0:414bd7c6b901 | 2 | |
lorzangas | 0:414bd7c6b901 | 3 | BusOut myleds(LED1, LED2, LED3, LED4); |
lorzangas | 0:414bd7c6b901 | 4 | BusOut motor(p10, p11, p12, p13); |
lorzangas | 0:414bd7c6b901 | 5 | |
lorzangas | 1:26c2fd1ea036 | 6 | /* Paso p10 p11 p12 p13 |
lorzangas | 1:26c2fd1ea036 | 7 | 1 1 0 1 0 |
lorzangas | 1:26c2fd1ea036 | 8 | 2 0 1 1 0 |
lorzangas | 1:26c2fd1ea036 | 9 | 3 0 1 0 1 |
lorzangas | 1:26c2fd1ea036 | 10 | 4 1 0 0 1 |
lorzangas | 0:414bd7c6b901 | 11 | */ |
lorzangas | 1:26c2fd1ea036 | 12 | int tiempo = 12000;//tiempo en us (tiempo entre pasos) nos da la velocidad |
lorzangas | 0:414bd7c6b901 | 13 | int main() { |
lorzangas | 0:414bd7c6b901 | 14 | while(1) { |
lorzangas | 1:26c2fd1ea036 | 15 | for (int s = 0; s < 120 ; s +=1) {//el 120 indica 120*4 pasos, en mi motor de 48 pasos 10 vueltas |
lorzangas | 1:26c2fd1ea036 | 16 | motor = (0xA); //1010 |
lorzangas | 0:414bd7c6b901 | 17 | wait_us(tiempo); |
lorzangas | 1:26c2fd1ea036 | 18 | motor = (0x6);//0110 |
lorzangas | 0:414bd7c6b901 | 19 | wait_us(tiempo); |
lorzangas | 1:26c2fd1ea036 | 20 | motor = (0x5);//0101 |
lorzangas | 0:414bd7c6b901 | 21 | wait_us(tiempo); |
lorzangas | 1:26c2fd1ea036 | 22 | motor = (0x9);//1001 |
lorzangas | 0:414bd7c6b901 | 23 | wait_us(tiempo); |
lorzangas | 0:414bd7c6b901 | 24 | } |
lorzangas | 0:414bd7c6b901 | 25 | wait(2); |
lorzangas | 1:26c2fd1ea036 | 26 | for (int s = 0; s < 120 ; s +=1) {//ahora en sentido contrario |
lorzangas | 2:42e4a5fcc99f | 27 | motor = (0x9);//1001 |
lorzangas | 0:414bd7c6b901 | 28 | wait_us(tiempo); |
lorzangas | 1:26c2fd1ea036 | 29 | motor = (0x5);//0101 |
lorzangas | 0:414bd7c6b901 | 30 | wait_us(tiempo); |
lorzangas | 1:26c2fd1ea036 | 31 | motor = (0x6);//0110 |
lorzangas | 0:414bd7c6b901 | 32 | wait_us(tiempo); |
lorzangas | 1:26c2fd1ea036 | 33 | motor = (0xA);//1010 |
lorzangas | 0:414bd7c6b901 | 34 | wait_us(tiempo); |
lorzangas | 0:414bd7c6b901 | 35 | } |
lorzangas | 0:414bd7c6b901 | 36 | wait(2); |
lorzangas | 0:414bd7c6b901 | 37 | } |
lorzangas | 0:414bd7c6b901 | 38 | } |