zhaw_st16b_pes2_10 / Mbed 2 deprecated PES_Official-US

a

Dependencies:   Servo ServoArm mbed

Fork of PES_Official-TestF by zhaw_st16b_pes2_10

Sources/Farbsensor.cpp@4:67d7177c213f, 2017-04-19 (annotated)

Committer:
beacon
Date:
Wed Apr 19 12:23:52 2017 +0000
Revision:
4:67d7177c213f
Parent:
1:388c915756f5
Child:
10:f76476943a6c
l;

Who changed what in which revision?

UserRevisionLine numberNew contents of line
beacon 1:388c915756f5 1 #include "Robot.h"
beacon 4:67d7177c213f 2 #include "Declarations.h"
beacon 1:388c915756f5 3
beacon 1:388c915756f5 4
beacon 1:388c915756f5 5 Farbsensor::Farbsensor()
beacon 1:388c915756f5 6 {
beacon 1:388c915756f5 7 }
beacon 1:388c915756f5 8
beacon 1:388c915756f5 9 Farbsensor::Farbsensor(AnalogIn* FarbVoltage)
beacon 1:388c915756f5 10 {
beacon 1:388c915756f5 11 init(FarbVoltage);
beacon 1:388c915756f5 12 }
beacon 1:388c915756f5 13
beacon 1:388c915756f5 14 void Farbsensor::init(AnalogIn* FarbVoltage)
beacon 1:388c915756f5 15 {
beacon 1:388c915756f5 16 this->FarbVoltage= FarbVoltage;
beacon 1:388c915756f5 17 }
beacon 1:388c915756f5 18
beacon 1:388c915756f5 19 int Farbsensor::read()
beacon 1:388c915756f5 20 {
beacon 1:388c915756f5 21 int farbe;
beacon 1:388c915756f5 22 float Ufarbsensor=FarbVoltage->read();
beacon 1:388c915756f5 23 Ufarbsensor=Ufarbsensor*3300; //Set the Voltage between 0mV und 3300mV
beacon 1:388c915756f5 24
beacon 1:388c915756f5 25 if ((Ufarbsensor > GREEN_DOWNLIMIT) && (Ufarbsensor < GREEN_UPLIMIT))
beacon 1:388c915756f5 26 {
beacon 1:388c915756f5 27 farbe=1;
beacon 1:388c915756f5 28 }
beacon 1:388c915756f5 29 else if(Ufarbsensor < RED_UPLIMIT)
beacon 1:388c915756f5 30 {
beacon 1:388c915756f5 31 farbe=-1;
beacon 1:388c915756f5 32 }
beacon 1:388c915756f5 33 else
beacon 1:388c915756f5 34 {
beacon 1:388c915756f5 35 farbe=0;
beacon 1:388c915756f5 36 }
beacon 1:388c915756f5 37 return farbe;
beacon 1:388c915756f5 38 }
beacon 1:388c915756f5 39
beacon 1:388c915756f5 40 Farbsensor::operator int()
beacon 1:388c915756f5 41 {
beacon 1:388c915756f5 42 return read();
beacon 1:388c915756f5 43 }