Do NOT modify!

Dependencies:   mbed Servo ServoArm

Fork of PES_Yanick by zhaw_st16b_pes2_10

Revision:
1:388c915756f5
Child:
4:67d7177c213f
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/Sources/Farbsensor.cpp	Sun Mar 19 12:20:26 2017 +0000
@@ -0,0 +1,42 @@
+#include "Robot.h"
+
+
+Farbsensor::Farbsensor()
+{   
+}
+
+Farbsensor::Farbsensor(AnalogIn* FarbVoltage)
+{
+    init(FarbVoltage);  
+}
+
+void Farbsensor::init(AnalogIn* FarbVoltage)
+{
+    this->FarbVoltage= FarbVoltage;
+}
+
+int Farbsensor::read()
+{
+    int farbe;  
+    float Ufarbsensor=FarbVoltage->read();
+    Ufarbsensor=Ufarbsensor*3300; //Set the Voltage between 0mV und 3300mV
+
+    if ((Ufarbsensor > GREEN_DOWNLIMIT) && (Ufarbsensor < GREEN_UPLIMIT))
+        {
+         farbe=1;
+        }
+    else if(Ufarbsensor < RED_UPLIMIT)
+        {
+         farbe=-1;
+        }
+    else 
+        {
+         farbe=0;
+        }
+    return farbe;
+}
+
+Farbsensor::operator int()
+{
+    return read();
+}
\ No newline at end of file