Advertisement
Krzyspx

Untitled

Dec 12th, 2019
515
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C++ 1.73 KB | None | 0 0
  1. #include <Timers.h> //  my favorite timer
  2. Timers <4> akcja; // 4  wątki
  3.  
  4. void setup() {
  5.   Serial.begin(9600,SERIAL_8N1);
  6.   Serial1.begin(9600,SERIAL_8N1);
  7.   Serial1.setDebugOutput(true);
  8. //  pinMode(LED_BUILTIN, OUTPUT);
  9.   Serial.println("test started");
  10.   Serial1.println("xxxxxxx");
  11.   akcja.attach(0, 3000, blinkled);
  12. }
  13.  
  14. bool wsk2 = 0;
  15. bool wsk1 = 0;
  16. void  blinkled() {
  17.   Serial.print("-");
  18.   wsk2 = !wsk2;
  19.   if (wsk2)wsk1 = !wsk1;
  20.  
  21.  // digitalWrite(LED_BUILTIN, wsk2);
  22.   //    Serial.println("abcd");
  23.  
  24.   if (wsk1 == 0) {
  25.     if (wsk2 == 0) {
  26.       Serial1.write(0xBB);
  27.       Serial1.write(0xCC);
  28.       Serial1.write(0x00);
  29.       Serial1.write(0x00);
  30.       Serial1.write(0x00);
  31.       Serial1.write(0x00);
  32.       Serial1.write(0xB4);
  33.       //     Serial.println("1");
  34.     } else  {
  35.       Serial1.write(0xBB);
  36.       Serial1.write(0xCC);
  37.       Serial1.write(0x00);
  38.       Serial1.write(0x01);
  39.       Serial1.write(0x00);
  40.       Serial1.write(0x00);
  41.       Serial1.write(0xDF);
  42.       //     Serial.println("2");
  43.     }
  44.   }
  45.  
  46.  
  47.   if (wsk1 == 1) {
  48.     if (wsk2 == 0) {
  49.       Serial1.write(0xBB);
  50.       Serial1.write(0xCC);
  51.       Serial1.write(0x01);
  52.       Serial1.write(0x00);
  53.       Serial1.write(0x00);
  54.       Serial1.write(0x00);
  55.       Serial1.write(0x88);
  56.       //     Serial.println("3");
  57.     } else  {
  58.       Serial1.write(0xBB);
  59.       Serial1.write(0xCC);
  60.       Serial1.write(0x01);
  61.       Serial1.write(0x01);
  62.       Serial1.write(0x00);
  63.       Serial1.write(0x00);
  64.       Serial1.write(0x89);
  65.       //     Serial.println("4");
  66.     }
  67.   }
  68. }
  69. void half_bridge() {
  70.   while (Serial.available() > 0) {
  71.     Serial.write(Serial.read());
  72.     yield();
  73.  
  74.   }
  75. }
  76.  
  77. void loop() {
  78.   akcja.process(); //
  79.   half_bridge();
  80.  
  81. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement