hall_silnik
Dependencies: mbed
main.cpp
- Committer:
- abm_mechatronika
- Date:
- 2015-04-20
- Revision:
- 0:fd8d6f3975c1
File content as of revision 0:fd8d6f3975c1:
#include "mbed.h" //hall_silnik int analog_zero_1 = 0; AnalogIn hallotron_silnik(PTB1); Serial pc(USBTX, USBRX); float voltage(AnalogIn czujnik, float zero_analog) { return (czujnik.read() - zero_analog) * 2.9035; } int main() { pc.baud(9600); int i=0; int p=0; int r=0; int k=0; float o=0; float m,n; float suma = 0; float suma2 = 0; while(true) { m = voltage(hallotron_silnik, analog_zero_1); if (m > 1.5) { p=1; } for (i=0; i<10; i++) { wait_us(10); m = voltage(hallotron_silnik, analog_zero_1); suma = suma + m; } n = voltage(hallotron_silnik, analog_zero_1); if (n < 0.9) { r = 1; } else r=0; for (i=0; i<10; i++) { wait_us(10); n = voltage(hallotron_silnik, analog_zero_1); suma2 = suma2 + n; } if ((p==1) && (r==1) && (suma>suma2)) { pc.printf("obrot %.2f\n", o); p=0; o=o+0.25; } pc.printf("%.d\n",k); k++; wait_ms(10); suma = m; suma2 = n; } }