Diff: Sources/Farbsensor.cpp

Revision:

9:ac362674c480

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/Sources/Farbsensor.cpp	Tue May 02 08:39:35 2017 +0000
@@ -0,0 +1,43 @@
+#include "Robot.h"
+#include "Declarations.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