Do NOT modify!

Dependencies:   mbed Servo ServoArm

Fork of PES_Yanick by zhaw_st16b_pes2_10

Committer:
beacon
Date:
Sun Mar 19 12:20:26 2017 +0000
Revision:
1:388c915756f5
Child:
4:67d7177c213f
[404 message not found]

Who changed what in which revision?

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