Posts mit dem Label InterruptPort werden angezeigt. Alle Posts anzeigen
Posts mit dem Label InterruptPort werden angezeigt. Alle Posts anzeigen

Dienstag, 27. Mai 2014

TCS3200 Farbsensor einlesen (Netduino)

TCS3200_01

Das Licht leuchtet hier in verschiedenen Farben. Mit Hilfe des TCS3200 Sensor, können die verschiedenen Farben gemessen werden. Anders als bei einem lichtempfindlichen Sensor, an dem sich der Leitwert verändert, liegt ein Pulssignal an. Für die Schaltung werden insgesamt fünf Digitale Ports und zwei Pins für die Spannungsversorgung benötigt.

image

Wenn mal kein Breadboard zur verfügung steht, geht das auch so wie im folgendem Bild. Die Pins von S0 bis S3 und OUT auf die digitalen Ausgängen von Pin 2 bis Pin 6 steckt.

TCS3200_Netduino_03

Wie die Schaltung bereits verrät, ist das einlesen deutlich anders. Anstatt über OneWire , I²C oder eines Spannungspegel, kommt ein PWM (oder auch PPM) Signal. Je nach Farbe müssen die Anschlüsse von S0 bis S3 entsprechend geschaltet sein. Das bedeutet wiederum, dass die Farben nacheinander gemessen werden. Im .NET Micro Framework gibt es zum Einlesen die Klasse "InteruptPort", mit der auf das PWM Signal reagiert werden kann. Das erfordert etwas zusätzlichen Programmcode.

// Optionen für Ausgangsfrequenz
public enum
OutputFrequencyScaling
{
    PowerDown,
    TwoPercent,
    TwentyPercent,
    HundredPercent
}

// Filter Auswahl
public enum SelectColor
{
    Red,
    Blue,
    Green,
    Clear
}

public class Program
{
    // Die Klasse wird für das Einlesen des PWM Signals verwendet.
   private static InterruptPort _IntPort = new InterruptPort(
        Pins.GPIO_PIN_D6,
        true,
        Port.ResistorMode.Disabled,
        Port.InterruptMode.InterruptEdgeBoth);

    // Ruft die gemessene Zeit ab,
    // wann die HIGH Pegele begonnen hat oder legt diese fest.
    private static long _HighTicks = 0;

    // S0 und S1 Schaltet die Ausgangs frequenz entsprechend ein (Siehe dazu Datasheet)
    private static OutputPort _S0 = new OutputPort(Pins.GPIO_PIN_D2, false);
   private static OutputPort _S1 = new OutputPort(Pins.GPIO_PIN_D3, false);

   // S2 und S3 Schaltet die verschiedenen Filter Möglichkeiten ein
    private static OutputPort _S2 = new OutputPort(Pins.GPIO_PIN_D4, false);
    private static OutputPort _S3 = new OutputPort(Pins.GPIO_PIN_D5, false);

    // Die Onboard LED als Status Aktivität
    private static OutputPort _StatusLED = new OutputPort(Pins.ONBOARD_LED, false);

    private static string _readColorName = string.Empty;

    private static bool _valueIsSet = false;
    private static long _resultTemp = 0;
    private static int _resultRed = 0;
    private static int _resultBlue = 0;
    private static int _resultGreen = 0;
    private static int _resultClear = 0;

    public static void Main()
    {
        OutputFrequencyScaling scale = OutputFrequencyScaling.TwoPercent;

       while (true)
        {
          
// Status Lesen
            _StatusLED.Write(true);

            // Farben nach einander einlesen.
            ReadPwmSignal(ref _resultRed, SelectColor.Red, scale);
            ReadPwmSignal(ref _resultBlue, SelectColor.Blue, scale);
            ReadPwmSignal(ref _resultGreen, SelectColor.Green, scale);
            ReadPwmSignal(ref _resultClear, SelectColor.Clear, scale);

            // Ausgabe über die Messergebnisse.
            Debug.Print("Red:" + _resultRed.ToString() +
               "\t Blue:" + _resultBlue.ToString() +
               "\t Green:" + _resultGreen.ToString() +
               "\t Clear:" + _resultClear.ToString());

           // Status warten
            _StatusLED.Write(false);
           Thread.Sleep(500);
        }
           
    }

    // Methode mit Filter- und Ausgangsfrequenzschalten und gibt das Ergebnis über "result" zurück.
   private static void ReadPwmSignal(ref int result, SelectColor color, OutputFrequencyScaling scaling)
    {
       // Ausgangsfrequenz schalten
        switch (scaling)
        {
            case (OutputFrequencyScaling.TwoPercent): { _S0.Write(false); _S1.Write(true); break; }
            case (OutputFrequencyScaling.TwentyPercent): { _S0.Write(true); _S1.Write(false); break; }
           case (OutputFrequencyScaling.HundredPercent): { _S0.Write(true); _S1.Write(true); break; }
            default: { _S0.Write(false); _S1.Write(false); break; }
        }

        // Filter einstellen
        switch (color)
        {
            case (SelectColor.Red): { _S2.Write(false); _S3.Write(false); break; }
            case (SelectColor.Blue): { _S2.Write(false); _S3.Write(true); break; }
            case (SelectColor.Green): { _S2.Write(true); _S3.Write(true); break; }
            default: { _S2.Write(true); _S3.Write(false); break; }
        }

       // Member für das erfassen des Messergebnisses.
        _HighTicks = 0;
        _resultTemp = 0;
        _valueIsSet = false;

        // Event zuweisen
        _IntPort.OnInterrupt += _IntPort_OnInterrupt;

        // Warten
        for (int i = 0; i < 5; i++) { Thread.Sleep(2); }

        // Event wieder abziehen
        _IntPort.OnInterrupt -= _IntPort_OnInterrupt;
           
        // Ergebniss kopieren
        result = (int)_resultTemp;
    }

    // Wird ausgeführt, wenn sich der Pegel am Digitalen Port geändert hat.
    private static void _IntPort_OnInterrupt(uint data1, uint data2, DateTime time)
    {
        // Lock verhindert, das ein zweiter unmittelbarer Event nicht erfolgen kann.
        lock (_IntPort)
        {
           // Wenn noch kein Wert erfasst wurde.
            if (!_valueIsSet)
            {
               // Wenn HIGH Pegel anlieg und die Aktuelle
                // Zeit in Ticks noch nicht erfast wurde.
                if (data2 == 1 & _HighTicks == 0)
                {
                    // Aktuelle Zeit in Ticks zwischen speichern
                    _HighTicks = time.Ticks;
                }
                else if (_HighTicks != 0 & !_valueIsSet)
                {
                    // Wenn der Pegel von HIGH nach LOW gewechselt hat
                    _resultTemp = time.Ticks - _HighTicks;
                   // True zuweisen, dass der Messwert erfasst wurde
                    _valueIsSet = true;
                    // Event abziehen
                    _IntPort.OnInterrupt -= _IntPort_OnInterrupt;
                }
            }
        }
    }
}

Als Ausgangsergebnis werden vier Werte wiedergegeben. Wenn nun vor dem Sensor eine Farbige Fläche mit einer der Grundfarben gehalten wird, dann verändern sich die Werte dementsprechend. Stammt die Farbe von einem Bildschirm (wie im folgenden Bild von einem Smart Phone), dann kann der Blaue Jumper herausgezogen werden, um die LED Beleuchtung abzustellen.

TCS3200_Netduino_01

  Bei grob angemalten Flächen wie dieser Karteikarte funktioniert es weniger gut..

TCS3200_Netduino_02

Anhand der Farbe stellen sich die Werte neu ein. Je ein deutiger die Farbe ist, um so deutlicher zeigt sich das Ergebnis.

Also bei durch gehenhenden Blau, Grün oder Rot zeigt sich ein hoher Wert. Wenn die Farbfläche jedoch wie bei meinem Beispiel mit der Karteikarte durchgeführt wird, stehen an jeden Ausgang relativ hohe Werte.

image

Noch ein Hinweis. Die Pulslänge wird kürzer, wenn der Weg des reflecktierten Licht kürzer wird, oder salobt gesagt, wenn die Farbfläche zu nah am Sensor ist, dann ist das Pulssignal sehr kurz. Dies führt dann dazu, dass die letzte Methode sehr häufig ausgeführt wird. Im schlimmsten Fall kommt es zu einem Speicherüberlauf und das Programm bleibt stehen.

Beispiel Programm zum Herunterladen für Netduino mit .NET Micro Framework 4.2

Mittwoch, 1. Mai 2013

PWM Signal Einlesen mit dem Netduino

PwmSignal_Netduino2
Der Empfänger am Netduino

Es gibt zwei Lösungen, wie man ein PWM Signal einlesen kann. Über eine RC Schaltung mit der “AnalogInput” Klasse oder vollständig programmatisch. Wenn keine Bauteile wie Widerstand und Kondensator vorhanden ist, dann erübrigt sich das letztere. Beim Arduino kennt man bereits aus der Library die Methode ‘pulseIn()’. Leider wurde das für den Netduino noch nicht umgesetzt. Alternativ bleibt die Möglichkeit, die sich ändernden Pulszustände zeitlich zu messen und das geht hervorragend mit der “InterruptPort” Klasse.

/// <summary>
/// Dieses Klasse ermöglicht das genaue Einlesen des eingehenden Pulssignals
/// </summary>
private static InterruptPort _IntPort = new InterruptPort(
    Pins.GPIO_PIN_D0,
    true,
    Port.ResistorMode.Disabled,
    Port.InterruptMode.InterruptEdgeBoth);

/// <summary>
/// Wird verwendet um den Startzeit des Pulssignals zu merken
/// </summary>
private static long _HighTicks = 0;
/// <summary>
/// Kann verwendet werden um einen Servo anzusteuern
/// </summary>
private static PWM _PwmOutput = new PWM(Cpu.PWMChannel.PWM_0, 20000, 1500, PWM.ScaleFactor.Microseconds, false);

public static void Main()
{
    // PWM Ausgang starten
    _PwmOutput.Start();
    // Event zuweisen
    _IntPort.OnInterrupt += new NativeEventHandler(_IntPort_OnInterrupt);

    while (true)
    {
        Thread.Sleep(1000);
    }
}
/// <summary>
/// Wird ausgeführt, wenn sich der Zustand am Eingang geändert hat.
/// </summary>
private static void _IntPort_OnInterrupt(uint data1, uint data2, DateTime time)
{
   if (data2 == 1)
    {
        // Startzeit des Pulssignals merken
        _HighTicks = time.Ticks;
    }
    else
    {
        // Mit Ende des High Zustands wird die aktuelle
        // Zeit mit der begin Zeit abgerechnet und erhält hier
        // die Pulslänge des High Signals

        double result = time.Ticks - _HighTicks;

        // Werte werden zwischen 10.000 bis 20.000 ausgegeben
        Debug.Print(result.ToString());

       if (result < 20000)
        {
            // Das Pulssignal darf nur zwischen 1000 bis 2000 sein
            _PwmOutput.Duration = (uint)(result / 10);
        }
    }
}

Zum einlesen eines PWM Signals

Über die PWM Klasse gebe ich das eingelesene Signal wieder aus, um z.B. einen Servo oder Regler anzusteuern. Sinn ergibt dies jedoch, wenn der Wert noch verarbeitet wird, bevor es weiter gegeben wird.

Solution zum Downloaden: ExampleReadPwm

Ameisen Simulation und andere Dinge

Wer lange sich schon mit C# beschäftig, hat sicherlich schon mal was von AntMe gelesen oder gehört. Diese Idee hatte ich aufgegriffen und mi...