Advertisement
Guest User

Arduino I2C from RoboRio

a guest
Jan 22nd, 2018
328
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C 0.75 KB | None | 0 0
  1. int LEDmode = 0;
  2. String LED = "";
  3.  
  4. void setup()
  5. {
  6.   strip.begin();
  7.   strip.show();
  8.   Wire.begin(4);
  9.   Wire.onReceive(dataReceived);
  10. }
  11.  
  12. void loop()
  13. {
  14.   RunLEDs(LEDmode);
  15. }
  16.  
  17. void dataReceived(int howMany)
  18. {
  19.     LED = "";
  20.  
  21.     while ( Wire.available() > 0 ){
  22.       char n=(char)Wire.read();
  23.       if(((int)n)>((int)(' ')))
  24.       LED += n;
  25.     }
  26.  
  27.     if(LED == "DISABLED"){
  28.         LEDmode = 0;
  29.     }else if(LED == "AUTO"){
  30.         LEDmode= 1;
  31.     }else if(LED == "TELEOP"){
  32.         LEDmode = 2;
  33.     }else{
  34.         LEDmode = 0;
  35.     }
  36. }
  37.  
  38. void RunLEDs(int mode)
  39. {
  40.     if(LED == "DISABLED"){
  41.         chaseColor(255, 255, 255, 10);
  42.     }else if(LED == "AUTO"){
  43.         fadeRed(10);
  44.     }else if(LED == "TELEOP"){
  45.         fadeRed(10);
  46.     }else{
  47.       chaseColor(255, 255, 255, 10);
  48.     }
  49. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement