funzionamento un motore
Dependencies: X_NUCLEO_IHM01A1 mbed Motori_ultrasuoni_prova
Fork of HelloWorld_IHM01A1_2Motors by
main.cpp
- Committer:
- Ghilardi
- Date:
- 2017-03-16
- Revision:
- 31:1a64d3e86c03
- Parent:
- 30:f3d8978c68d4
File content as of revision 31:1a64d3e86c03:
#include "hcsr04.h" /* mbed specific header files. */ #include "mbed.h" /* Helper header files. */ #include "DevSPI.h" /* Component specific header files. */ #include "L6474.h" /* Number of steps. */ #define STEPS 3200 /* Delay in milliseconds. */ #define DELAY_1 2000 #define DELAY_2 6000 #define DELAY_3 8000 /* Speed in pps (Pulses Per Second). In Full Step mode: 1 pps = 1 step/s). In 1/N Step Mode: N pps = 1 step/s). */ #define SPEED_1 2400 #define SPEED_2 1200 /* Motor Control Component. */ L6474 *motor1; HCSR04 sensor(PB_8, PB_9); int distanza; /* Initializing SPI bus. */ DevSPI dev_spi(D11, D12, D13); DigitalOut led(D11); /* Initializing Motor Control Components. */ void thread(void const *args) { while (1) { // Avvia un impulso della durata di 10us sul pin di trigger sensor.start(); // Aspetta prima della prossima lettura wait_ms(100); // Stampa sulla seriale la misura della distanza in cm distanza = sensor.get_dist_cm(); } if(distanza > 10) motor1->run(StepperMotor::FWD); else led = 0; }