1

Dependencies:   mbed

main.cpp

Committer:
abm_mechatronika
Date:
2015-04-20
Revision:
0:22d018a3b548

File content as of revision 0:22d018a3b548:

#include "mbed.h"

int analog_zero_0 = 0;
AnalogIn fotorezystor(PTB0);
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(fotorezystor, analog_zero_0);    
    if (m < 0.05)
        p=1;
    
    for (i=0; i<10; i++)
    {
        wait_us(10);
        m = voltage(fotorezystor, analog_zero_0);
        suma = suma + m;
    }

    n = voltage(fotorezystor, analog_zero_0);
    if (n > 0.4)
        r = 1;
    else r=0;

    for (i=0; i<10; i++)
    {
        wait_us(10);
        n = voltage(fotorezystor, analog_zero_0);
        suma2 = suma2 + n;
    }

    if ((p==1) && (r==1) && (suma>suma2))
    {
        pc.printf("obrot\t%.2f\n",o);
        p=0;
        o=o+0.25;
    }
        
    pc.printf("%.d\n",k);
    k++;
    wait_ms(10);
    suma = m;
    suma2 = n;
    }
}