Hallo,

ich habe ein kleiens Programm für den Roboter zur C2 geschrieben. Da meine C2 nicht funktioniert wäre es nett, wenn das mal jemand bei sich ausprobiert.
Zusätzlich zum Modul muss noch das Modul "ccrp5" aus Gemeinsame module geladen sein
Das Programm soll den Roboter vorwärts fahren lassen. Sobald das ACS ein Hinderniss erkennt soll er das auf den Dioden ausgeben und anhalten.

Hier der Code

Code:
thread main
{
// Deklaration der Variablen
string s;
int VALUE;
int STATUS;
           // Modul initialisieren
           VALUE=ccrp5.init();
           // Reset
           ccrp5.clear();
           // Alle LED´s aus
           ccrp5.LEDSoff();
           // Empfindlichkeit des ACS Systems auf höchste Sensitivität
           ccrp5.setACSHI();
           // Beginn der Schleife
           loop
           {
               // Subsystem abfragen
               STATUS=ccrp5.getCNSTAT();
               // Wenn der rechter Sensor anspricht
               if (STATUS and 0x01)==1
               {
               // .. dann LED 4 an
                ccrp5.LEDon(4);
               // .. dann Stopp
                ccrp5.FWD(0,0);
               }
               // .. sonst
               else
               {
               // .. LED 4 aus
                ccrp5.LEDoff(4);
               // .. vorwärts, Geschwindigkeit 150
                ccrp5.FWD(150,150);
               }
               // Wenn der linke Sensor anspricht
               if (STATUS and 0x02)==2
               {
               // .. dann LED 1 an
                ccrp5.LEDon(1);
               // .. dann Stopp
                ccrp5.FWD(0,0);
               }
               // .. sonst
               else
               {
               // .. LED 1 aus
                ccrp5.LEDoff(1);
               // .. vorwärts, Geschwindigkeit 150
                ccrp5.FWD(150,150);
               }
           }
}
Danke im voraus


Gruß

Thomas