ChibiOS Free Embedded RTOS

Code: Select all

static msg_t Thread4(void *arg)
{
   (void)arg;
   chRegSetThreadName("BLEData");

   static unsigned char data[256];
   static struct ble_header hdr;
   static uint32_t payload_length = 0, cnt_received = 0;

   EventListener elBLEData;
   flagsmask_t flags;
   chEvtRegisterMask((EventSource *)chnGetEventSource(&SD1), &elBLEData, EVENT_MASK(1));

   while (TRUE)
   {
      chEvtWaitAllTimeout(EVENT_MASK(1), TIME_IMMEDIATE);
      chSysLock();
      flags = chEvtGetAndClearFlags(&elBLEData);
      chSysUnlock();

      if(flags & SD_PARITY_ERROR){                                          // Parity error happened.
         gwinPrintf(GW1, "[UART] parity error\n");
         gdispFlush();
      }
      if(flags & SD_FRAMING_ERROR){                                       // Framing error happened.
         gwinPrintf(GW1, "[UART] framing error\n");
         gdispFlush();
      }
      if(flags & SD_OVERRUN_ERROR){                                       // Overflow happened.
         gwinPrintf(GW1, "[UART] Overflow\n");
         gdispFlush();
      }
      if(flags & SD_NOISE_ERROR){                                          // Noise on the line.
         gwinPrintf(GW1, "[UART] Noisy line\n");
         gdispFlush();
      }
      if(flags & SD_BREAK_DETECTED){                                       // Break detected.
         gwinPrintf(GW1, "[UART] Break!\n");
         gdispFlush();
      }
      if(flags & CHN_INPUT_AVAILABLE)
      {
         ledFlash();                                                   //Indicate: something has been received

         msg_t charbuf;
         do{                                                         //Read all there is into buffer
            charbuf = chnGetTimeout(&SD1, TIME_IMMEDIATE);                                                    
            if(charbuf != Q_TIMEOUT){
               if(cnt_received < sizeof(hdr)){
                  if(cnt_received == 0)
                     hdr.type_hilen = (uint8_t)charbuf;
                  if(cnt_received == 1)
                     hdr.lolen = (uint8_t)charbuf;
                  if(cnt_received == 2)
                     hdr.cls= (uint8_t)charbuf;
                  if(cnt_received == 3)
                     hdr.command= (uint8_t)charbuf;
               }
               else
                  data[cnt_received - sizeof(hdr)] = (uint8_t)charbuf;

               cnt_received++;
            }
         }
         while(charbuf != Q_TIMEOUT);

         if(cnt_received >= sizeof(hdr)){                                    //Do we have at least the header bytes?
            payload_length = ((uint32_t)(hdr.type_hilen & 0x07))<<8 | (uint32_t)hdr.lolen;
            if(cnt_received >= sizeof(hdr)+payload_length){                     //Have we gathered all payload bytes?
               cnt_received = 0;                                       //Reset receiver counter
               const struct ble_msg *msg = ble_get_msg_hdr(hdr);                  //Process message header
               if(!msg){
                  gwinPrintf(GW1, "[BLE] unknown message\n");
                  gdispFlush();
               }
               else
                  msg->handler(data);                                                            //Here message handler gets called
            }
         }
      }
   }
}

Code: Select all

int main(void) {
   halInit();
   chSysInit();

   tpBlinkBlue    = chThdCreateStatic(waThread_2, sizeof(waThread_2), NORMALPRIO, Thread2, NULL);   //Blinker thread from STM32 demo code
   tpButton      = chThdCreateStatic(waThread_3, sizeof(waThread_3), NORMALPRIO, Thread3, NULL);   //This sleeping reacts on button press events. IRQ wakes up this thread
   tpBLEData      = chThdCreateStatic(waThread_4, sizeof(waThread_4), NORMALPRIO, Thread4, NULL);   //This is the UART listener

   initDisplay();
   initUART();
   initBLE();
   extStart(&EXTD1, &extcfg);                    // Activates the EXT driver 1.

   while(TRUE){
   }
}

Code: Select all

palTogglePad(INDICATE_PORT, INDICATE_PIN);