Skip to content
Snippets Groups Projects
Select Git revision
  • d3573c6dfab3b86b91036c2123bd49fc8495556b
  • main default protected
2 results

index.html

Blame
  • spi_test.cpp 3.08 KiB
    #include <pigpio.h>
    #include <iostream>
    #include <unistd.h>
    #include <cstring>
    
    using namespace std;
    
    const uint8_t WIDTH = 40;
    const uint8_t HEIGHT = 13;
    
    class Pixel {
      public:
        Pixel(uint8_t r = 0, uint8_t g = 0, uint8_t b = 0) : r(r), g(g), b(b) {}
      private:
        uint8_t r;
        uint8_t g;
        uint8_t b;
    };
    
    class Frame {
      private:
        uint16_t duration;
        Pixel data[HEIGHT][WIDTH];
      public:
        Frame(Pixel data[HEIGHT][WIDTH], uint16_t duration) {}// : data(data), duration(duration) {}
        uint8_t* to_spi_data();
    };
    
    uint8_t* to_spi_data() {
      uint8_t* spi_data = new uint8_t[24*WIDTH*2];
      for (int x = 0; x < WIDTH; x++) {
        for (int y = 0; y < HEIGHT; y++) {
          0;
        }
      }
    }
    
    
    
    uint16_t dataRed[40*24] = {0};
    uint16_t dataGreen[40*24] = {0};
    uint8_t dataRed2[40*24*2] = {0};
    uint8_t dataGreen2[40*24*2] = {0};
    uint8_t ures[40*24*2+4] = {0};
    uint8_t teli[40*24*2+4] = {0};
    
    void initData()
    {
      for(size_t i = 0; i < 40; i++)
      {
        for(size_t j = 0; j < 24; j++)
        {
          dataRed[24*i+j] = 0;
          dataGreen[24*i+j] = 0;
        }    
        dataRed[24*i] = 0x0100;
        dataGreen[24*i+8] = 0x0100;
      }
      for(size_t i = 0; i < 40*24; i++)
      {
        dataRed2[2*i] = dataRed[i] >> 8;
        dataRed2[2*i + 1] = dataRed[i];
        dataGreen2[2*i] = dataGreen[i] >> 8;
        dataGreen2[2*i + 1] = dataGreen[i];
      }
      teli[0] = 0x55;
      teli[1] = 0x55;
      teli[2] = 0x00;
      teli[3] = 0x02;
      for(size_t i = 4; i < 40*24*2+4; i++)
      {
        if (i % 2 == 0)
        {
          teli[i] = 1;
        }
      }
      
    }
    
    uint8_t* addHeader(uint8_t* ptr, uint16_t duration)
    {
      uint8_t* outData = new uint8_t[40*24*2 + 4];
      memcpy(outData + 4, ptr, 40*24*2);
      outData[0] = 0x55;
      outData[1] = 0x55;
      outData[2] = duration >> 8;
      outData[3] = duration;
      return outData;
    }
    
    void waitGPIO()
    {
      int tmp;
      usleep(12000);
      while((tmp = gpioRead(26)) != 1)
      {
        usleep(1000);
        //cout << "GPIO26 = " << tmp << endl;
    //    usleep(000);
      }
    }
    
    int main(int argc, char *argv[])
    {
      
      initData();
      gpioInitialise();
      gpioSetMode(26, PI_INPUT);
    
      uint8_t* outR = addHeader(dataRed2, 1);
      uint8_t* outG = addHeader(dataGreen2, 1);
      uint32_t flags = (1 << 20);
      int spiHandle = spiOpen(0, 4000000, flags);
      if(spiHandle >= 0) cout << "SPI Opened" << endl;
      char buff[2] = {0, 1}; //ez lesz így 0x0001
    
      cout << "Reading GPIO" << endl;
      // while((tmp = gpioRead(26)) != 1)
      // {
      //   cout << "GPIO26 = " << tmp << endl;
      //   sleep(1);
      // }
      // cout << "GPIO OK" << endl;
    
      ures[0] = 0x55;
      ures[1] = 0x55;  
      ures[2] = 0;
      ures[3] = 2;
      uint32_t tmp = 4;
    //  ures[40*24*2+3] = 0x55;
      int mode = 1;
      while(1)
      {
        spiWrite(spiHandle, (char*)ures, 40*24*2 + 4);
        waitGPIO();
        spiWrite(spiHandle, (char*)teli, 40*24*2 + 4);
        waitGPIO();
        ures[tmp] = mode;
        tmp += 2;
        tmp += 2;
        tmp += 2;
        tmp += 2;
        if (tmp >= 40*24*2)
        {
          tmp = 4;
          mode = (mode + 1) % 2;
        }
      }
    
      int cnt = 0;
      for(size_t i = 0; i < 40*24*2+4; i++)
      {
        if (outR[i] == 1)
          cnt++;
      }
      cout << cnt << endl;
      
      // spiWrite(spiHandle, outG, 40*24*2 + 4);
      // usleep(10000);
      delete outR;
      delete outG;
      
      return 0;
    }