test program

Dependencies:   mbed

Revision:
3:ff2ce4f4c5cf
Parent:
2:3875bc678188
Child:
4:cfc02c02dd97
--- a/main.cpp	Mon Jan 13 17:35:38 2020 +0000
+++ b/main.cpp	Mon Jan 13 17:45:38 2020 +0000
@@ -2,6 +2,7 @@
 #define BUTTON1 p14      // M3: push joystick pin
 // #define BUTTON1 A1       //NUCLEO: Taster A1
 
+int lauflicht(bool richtung, int time, int &anz);
 void nibbleLeds(int value);
 void printb(uint8_t x);
 
@@ -14,17 +15,49 @@
     int anzahl, anz;
     uint8_t value = INIT;
     
+    anzahl = lauflicht(true, 400, anz=0);
+    printf("anzahl= %d\n", anzahl);
+    
     nibbleLeds(value);
     printb(value);
     wait(0.1); 
 }
 
 
+int lauflicht(bool richtung, int time, int &anz) {
+    int i;
+    uint8_t lauf = 0x01;
+    
+    if(!richtung)
+        lauf = 0x08;
+    while(1) {
+        nibbleLeds(lauf&0x0F);
+        if(richtung) {
+            lauf = lauf >>1;
+            if(lauf < 8)
+                lauf = 0x01;
+        }
+        else {
+            lauf = lauf << 1;
+            if(lauf == 0)
+                lauf = 0x08;
+        }
+        if(button)
+            break;
+        wait_ms(time);
+        anz++;
+    }
+    return anz;
+}
+        
+
 void printb(uint8_t x) {
     for(int i=sizeof(x)<<3; i; i--)
         putchar('0'+((x<<(i-1))&1));
+    printf("\n");
     }
 
 void nibbleLeds(int value) {
     myleds = value%16;
-}
\ No newline at end of file
+}
+