#include <wiringPi.h>
#include <stdio.h>
#include <stdlib.h>

int i;

int main (void)
{

  // check wiringPi setup
  if (wiringPiSetup() == -1)
  {
        printf("wiringPi-Error\n");
    exit(1);
  }
       pinMode(1, PWM_OUTPUT);
       pinMode(23, PWM_OUTPUT);
       pinMode(24, PWM_OUTPUT);
       pwmSetMode(PWM_MODE_MS);
       pwmSetClock(1920);
       pwmSetRange(200);

       printf("Aktywne piny 1, 23 i 24\n");fflush(0);
       for(i=0;i<2;i++)
         {
          pwmWrite(1,5);
          pwmWrite(23,15);
          sleep(1);
          pwmWrite(1,25);
          pwmWrite(23,20);
          sleep(1);
         }
       printf("Aktywne piny 1 i 23\n");fflush(0);
       for(i=0;i<2;i++)
         {
       pinMode(24, OUTPUT);
          pwmWrite(1,5);
          pwmWrite(23,15);
          sleep(1);
          pwmWrite(1,25);
          pwmWrite(23,20);
          sleep(1);
         }

       printf("Aktywne piny 1, 23 i 24\n");fflush(0);
       pinMode(24, PWM_OUTPUT);
      pwmSetMode(PWM_MODE_MS);
       pwmSetClock(1920);
       pwmSetRange(200);

       for(i=0;i<2;i++)
         {
          pwmWrite(1,5);
          pwmWrite(23,15);
          sleep(1);
          pwmWrite(1,25);
          pwmWrite(23,20);
          sleep(1);
         }
}