BertlPractise
Fork of Bertl by
Diff: ur_Bertl.cpp
- Revision:
- 1:fafbac0ba96d
- Parent:
- 0:66e9a0afcbd6
- Child:
- 2:1cd559ff516b
--- a/ur_Bertl.cpp Thu Feb 26 10:12:06 2015 +0000 +++ b/ur_Bertl.cpp Thu Mar 19 19:12:33 2015 +0000 @@ -140,6 +140,13 @@ { char cmd[3]; + if(led == 0xBB) { + LED_blue=0; + return; + } else if (led == 0xFF) { + RGBLed(1,1,1); + LED_blue=0; + } cmd[0] = 0x02; cmd[1] = ~led; i2c.write(addr, cmd, 2); @@ -149,7 +156,13 @@ void ur_Bertl::TurnLedOff(int16_t led) { char cmd[3]; - + if(led == 0xBB) { + LED_blue=1; + return; + } else if (led == 0xFF) { + RGBLed(0,0,0); //don't work? + LED_blue=1; + } cmd[0] = 0x02; cmd[1] = led; i2c.write(addr, cmd, 2); @@ -217,9 +230,10 @@ } //---------------------------------------------------------------------- -/* + bool ur_Bertl::FrontIsClear() { +#ifdef HCSR int dist = 0; usensor.start(); wait_ms(10); @@ -228,8 +242,7 @@ return false; else return true; - DEBUG_PRINT("Distance: %d", dist); - +#else // if there is no ultra sonic sensor use this - with front buttons char cmd[3]; // array for I2C int16_t btns; @@ -249,9 +262,10 @@ wert = true; DEBUG_PRINT("WERT: %d", wert); return wert; +#endif } - +/* bool ur_Bertl::NextToABeeper() { if (BottomIsBlack())