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;
        
    }
}