Test Programm

Dependencies:   mbed

Revision:
4:3c91e63e0642
Parent:
3:9be1093ae35e
diff -r 9be1093ae35e -r 3c91e63e0642 main.cpp
--- a/main.cpp	Mon Jan 13 17:46:52 2020 +0000
+++ b/main.cpp	Mon Jan 13 18:02:29 2020 +0000
@@ -2,7 +2,7 @@
 #define BUTTON1 p14 // M3: push joystick pin 
 //#define BUTTON A1 // NUCLEO:Taster A1
 
-//int modifybBit (int x, unsigned char position, bool State);
+int modifyBit (int x, unsigned char position, bool State);
 int lauflicht (bool richtung, int time, int &anz);
 void nibbleLeds (int value);
 void printb (uint8_t x);
@@ -20,9 +20,20 @@
    printf("anzahl = %d\n", anzahl);
    
    nibbleLeds(value);
+   printb(value);
+   value = modifyBit(value, 2, 1);
+   printb(myleds);
+   printb(modifyBit(INIT, 3, 1));
    wait (0.1);
   }  
   
+  int modifyBit(int x, uint8_t position, bool State){
+      int mask = 1 << position;
+      int state = int(State);
+      return (x & ~mask) | ((state << position) & mask);
+      }
+  
+  
   int lauflicht(bool richtung, int time, int &anz){
       int i;
       uint8_t lauf = 0x01;