ChibiOS Free Embedded RTOS

Code: Select all

  static SerialUSBDriver SDU1;
  ...
  // Activates the USB driver (USB bus pull-up on D+ always hardware connected)
  sduObjectInit(&SDU1);
  sduStart(&SDU1, &serusbcfg);

  for (;;)
  {
     if (SDU1.config->usbp->state == USB_ACTIVE)
     {
         chprintf(&SDU1, "USB TEST\n\r");
     }
     chThdSleepMilliseconds(MS2ST(1000));
  }

Code: Select all

/*
 * Handles the USB driver global events.
 */
static void usb_event(USBDriver *usbp, usbevent_t event) {

  switch (event) {
  case USB_EVENT_RESET:
    return;
  case USB_EVENT_ADDRESS:
    return;
  case USB_EVENT_CONFIGURED:
    /* Enables the endpoints specified into the configuration.
       Note, this callback is invoked from an ISR so I-Class functions
       must be used.*/
    chSysLockFromIsr();
    usbInitEndpointI(usbp, USB_CDC_DATA_REQUEST_EP, &ep1config);
    usbInitEndpointI(usbp, USB_CDC_INTERRUPT_REQUEST_EP, &ep2config);
    usbInitEndpointI(usbp, USB_CDC_DATA_AVAILABLE_EP, &ep3config);
    chSysUnlockFromIsr();
    return;
  case USB_EVENT_SUSPEND:
    if (usbp->state == USB_ACTIVE)
    {
      // Cable unplugged
      chSysLockFromIsr();
      _usb_reset(usbp);
      // Reset input/output queues to unlock threads
      chIQResetI(&SDU1.iqueue);
      chOQResetI(&SDU1.oqueue);
      chSysUnlockFromIsr();
    }
    return;
  case USB_EVENT_WAKEUP:
    return;
  case USB_EVENT_STALLED:
    return;
  }
  return;
}

Code: Select all

void sduObjectInit(SerialUSBDriver *sdup) {

  sdup->vmt = &vmt;
  chEvtInit(&sdup->event);
  sdup->flags = IO_NO_ERROR;
  sdup->state = SDU_STOP;
  chIQInit(&sdup->iqueue, sdup->ib, SERIAL_USB_BUFFERS_SIZE, inotify);
  chOQInit(&sdup->oqueue, sdup->ob, SERIAL_USB_BUFFERS_SIZE, onotify);

  /* This is a dirty trick but those pointers are never used because queues
     are accessed in block mode from the low level.*/
  sdup->iqueue.q_wrptr = (uint8_t *)sdup;
  sdup->oqueue.q_rdptr = (uint8_t *)sdup;
}

Code: Select all

void USBOQResetI(OutputQueue *oqp) {

  chDbgCheckClassI();

  //oqp->q_rdptr = oqp->q_wrptr = oqp->q_buffer;
  //oqp->q_counter = chQSizeI(oqp);
  while (notempty(&oqp->q_waiting))
    chSchReadyI(fifo_remove(&oqp->q_waiting))->p_u.rdymsg = Q_RESET;
}

void USBIQResetI(InputQueue *iqp) {

  chDbgCheckClassI();

  //iqp->q_rdptr = iqp->q_wrptr = iqp->q_buffer;
  //iqp->q_counter = 0;
  while (notempty(&iqp->q_waiting))
    chSchReadyI(fifo_remove(&iqp->q_waiting))->p_u.rdymsg = Q_RESET;
}

Code: Select all

bool_t sduRequestsHook(USBDriver *usbp) {
  
  SerialUSBDriver *sdup = usbp->param;
  
  if ((usbp->setup[0] & USB_RTYPE_TYPE_MASK) == USB_RTYPE_TYPE_CLASS) {
    switch (usbp->setup[1]) {
    case CDC_GET_LINE_CODING:
      usbSetupTransfer(usbp, (uint8_t *)&linecoding, sizeof(linecoding), NULL);
      return TRUE;
    case CDC_SET_LINE_CODING:
      usbSetupTransfer(usbp, (uint8_t *)&linecoding, sizeof(linecoding), NULL);
      return TRUE;
    case CDC_SET_CONTROL_LINE_STATE:
      /* Nothing to do, there are no control lines.*/
      usbSetupTransfer(usbp, NULL, 0, NULL);
      return TRUE;
    /* My addition to support break character !!!! */        
    case CDC_SEND_BREAK :      
      chSysLockFromIsr();
      chIOAddFlagsI(sdup, SD_BREAK_DETECTED);
      chSysUnlockFromIsr();
      usbSetupTransfer(usbp, NULL, 0, NULL);
      return TRUE;
    default:
      return FALSE;
    }
  }
  return FALSE;
}

Code: Select all

flagsmask_t chEvtGetAndClearFlags(EventListener *elp)

Code: Select all

/*
 * Handles the USB driver global events.
 */
static void usb_event(USBDriver *usbp, usbevent_t event) {

  switch (event) {
  case USB_EVENT_RESET:
    return;
  case USB_EVENT_ADDRESS:
    return;
  case USB_EVENT_CONFIGURED:
    chSysLockFromIsr();

    /* Enables the endpoints specified into the configuration.
       Note, this callback is invoked from an ISR so I-Class functions
       must be used.*/
    usbInitEndpointI(usbp, USB_CDC_DATA_REQUEST_EP, &ep1config);
    usbInitEndpointI(usbp, USB_CDC_INTERRUPT_REQUEST_EP, &ep2config);

    /* Resetting the state of the CDC subsystem.*/
    sduConfigureHookI(usbp);

    chSysUnlockFromIsr();
    return;
  case USB_EVENT_SUSPEND:
    if (usbp->state == USB_ACTIVE)
    {
      // USB cable unplugged
      chSysLockFromIsr();
      _usb_reset(usbp);
      // Reset queues and unlock waiting threads
      chIQResetI(&SDU1.iqueue);
      chOQResetI(&SDU1.oqueue);
      chSysUnlockFromIsr();
    }
    return;
  case USB_EVENT_WAKEUP:
    return;
  case USB_EVENT_STALLED:
    return;
  }
  return;
}

Code: Select all

static void vtSockets_callback(void *para)
{
  // The associated function is invoked by an interrupt handler within the I-Locked state.

  chVTSetI(&vtSockets, MS2ST(1000), vtSockets_callback, NULL);
  
  for (int i=MAX_SOCKET_COUNT-1; i>0; i--)
  {
    int tmr = SOCKETS[i].timeout;
    if (tmr > 0) SOCKETS[i].timeout = --tmr;
  }
}

Code: Select all

static void vtSockets_callback(void *para)
{
  // The associated function is invoked by an interrupt handler within the I-Locked state.
  chSysLockFromIsr();
  chVTSetI(&vtSockets, MS2ST(1000), vtSockets_callback, NULL);
  
  for (int i=MAX_SOCKET_COUNT-1; i>0; i--)
  {
    int tmr = SOCKETS[i].timeout;
    if (tmr > 0) SOCKETS[i].timeout = --tmr;
  }
  chSysUnlockFromIsr();
}