Detected people approaching if the distance is < 6 feet then LEDs blinking RED otherwise LEDs light green.

Dependencies:   mbed X_NUCLEO_53L1A1_mbed WS2812

LED_WS2812/LED_WS2812.cpp

Committer:
elab
Date:
2020-09-29
Revision:
0:ea8694e55809

File content as of revision 0:ea8694e55809:

#include "LED_WS2812.h"



LED_WS2812::LED_WS2812(PinName _PinOut, int _nbLeds) {
     nbLeds = _nbLeds;
    double period_ns;
     Timer tuneTimings;
     int sum = 0;
     int nopRun;
     
     for(int kavg = 0; kavg<20;kavg++) {
         tuneTimings.reset();
         tuneTimings.start();
         for(int nopCount=0; nopCount < 10000; nopCount ++) {
             __nop();
         }
         tuneTimings.stop();
         nopRun = tuneTimings.read_us();
         sum=nopRun+sum;
     }
     period_ns = sum/200; /* *1000 for nanoseconds /20 average /10000 count */
     
     int zero_high = ZERO_HIGH/period_ns;
     int zero_low  = ZERO_LOW/period_ns;
     int one_high  = ONE_HIGH/period_ns;
     int one_low   = ONE_LOW/period_ns;
     
     ws = new WS2812(_PinOut, nbLeds,  zero_high, zero_low, one_high, one_low);
     ws->useII(WS2812::PER_PIXEL);
    
    pxArray = new PixelArray(nbLeds);
    pxInsert = new PixelArray(nbLeds);
    ResetColor();
    rotationState = false;
    rotationPosition = nbLeds-1;
    blinkState = false;
    blinkONOFF = false;
    intensity = 0xff;
};
  
LED_WS2812::~LED_WS2812() {
    delete(ws);
    delete(pxArray);
}



void LED_WS2812::SetColor(LED_COLORS _color, int position) {
      SetColor((unsigned int) _color, position);
};

void LED_WS2812::SetColor(unsigned int _color, int position) {
      if(position < nbLeds && position >=0 ) {
          pxArray->Set(position, _color);
          pxArray->SetI(position,intensity);
      
      }
      __writeBuf(0);
      nbInsert = 0;
      if(rotationState) StopRotation();
       rotationPosition = nbLeds;
};

void LED_WS2812::SetColor(LED_COLORS _color) {
      SetColor((unsigned int) _color);
};

void LED_WS2812::SetColor(unsigned int _color) {
      for(int i=0;i<nbLeds;i++) {
          pxArray->Set(i, _color);
          pxArray->SetI(i,intensity);
     }
       __writeBuf(0);
     nbInsert = 0;
     if(rotationState) StopRotation();
      rotationPosition = nbLeds;
};


void LED_WS2812::ResetColor() {
     SetColor(BLACK);
                  
 }

void LED_WS2812::__writeBuf(int z) {
     ws->write_offsets(pxArray->getBuf(),z,z,z);
     wait(0.01);
 }
 
void LED_WS2812::__insert2buf() {
     for(int i=0;i<nbLeds;i++) {
          pxArray->Set(i, pxInsert->Get(i%nbInsert));
      }
      __writeBuf(0);
      rotationPosition = nbLeds;    
}

void LED_WS2812::__insertColor(unsigned int _color, int _intensity) {
      pxInsert->Set(nbInsert%nbLeds,_color);
      pxInsert->SetI(nbInsert%nbLeds,_intensity);
      nbInsert++;
      
};
 
void LED_WS2812::InsertColor(unsigned int _color) {
      InsertColor(_color,intensity*100/0xFF);
};


void LED_WS2812::InsertColor(unsigned int _color, float brightness) {
       int pixelIntensity = brightness*0xFF/100;
       __insertColor(_color, pixelIntensity);
       __insert2buf();
};


void LED_WS2812::InsertColorNtimes(int N, unsigned int _color, float brightness) {
       for(int i=0;i<N;i++) {
             InsertColor(_color, brightness);
       }
};
    
void LED_WS2812::InsertColorNtimes(int N, unsigned int _color) {
       InsertColorNtimes(N, _color, intensity*100/0xFF);
};
      
    
void LED_WS2812::InsertColor(LED_COLORS _color) {
      InsertColor((unsigned int)_color);
};
   
 
void LED_WS2812::InsertColor(LED_COLORS _color, float brightness) {
     InsertColor((unsigned int)_color, brightness);
};


void LED_WS2812::InsertColorNtimes(int N, LED_COLORS _color, float brightness) {
      InsertColorNtimes(N, (unsigned int)_color, brightness);
};
    
void LED_WS2812::InsertColorNtimes(int N, LED_COLORS _color) {
       InsertColorNtimes(N, _color, intensity*100/0xFF);
};
      
   
void LED_WS2812::SetIntensity(float perCent) {
    intensity = perCent*0xFF/100;
    ws->setII(intensity);
    for(int i=0;i<nbLeds;i++) {
            pxArray->SetI(i,intensity);
    }
}
 
void LED_WS2812::StartRotation(float interval) {
    if(rotationState==false) {
       rotationState = true;
       LEDSystemTick.attach_us(callback(this, &LED_WS2812::Rotate), interval*1000000);
    }
}


void LED_WS2812::StopRotation() {
    if(rotationState==true) {
        rotationState = false;
        rotationPosition = 0;
        LEDSystemTick.detach();
    }
}

void LED_WS2812::Rotate() {
    rotationPosition--;
    if (rotationPosition == -1)
        rotationPosition = nbLeds-1;
    if(!blinkState)  __writeBuf(rotationPosition);
}


void LED_WS2812::StartBlink(float interval) {
    StopBlink();
    if(blinkState==false) {
       blinkState = true;
       LEDBlinkSystemTick.attach_us(callback(this, &LED_WS2812::Blink), interval*1000000);
    }
}


void LED_WS2812::StopBlink() {
    if(blinkState==true) {
        blinkState = false;
        LEDBlinkSystemTick.detach();
    }
}

void LED_WS2812::Blink() {
    blinkONOFF = !blinkONOFF;
    if (blinkONOFF)
        __writeBuf(rotationPosition);
    else {
            ws->useII(WS2812::GLOBAL);
            ws->setII(0);
           __writeBuf(rotationPosition);
            ws->useII(WS2812::PER_PIXEL);
            ws->setII(intensity);
            
    }
        
}