/*
 * The MIT License (MIT)
 *
 * Copyright (c) 2019 Ha Thach (tinyusb.org)
 *
 * Permission is hereby granted, free of charge, to any person obtaining a copy
 * of this software and associated documentation files (the "Software"), to deal
 * in the Software without restriction, including without limitation the rights
 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
 * copies of the Software, and to permit persons to whom the Software is
 * furnished to do so, subject to the following conditions:
 *
 * The above copyright notice and this permission notice shall be included in
 * all copies or substantial portions of the Software.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
 * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
 * THE SOFTWARE.
 *
 * This file is part of the TinyUSB stack.
 */
#ifdef __RTTHREAD__
#include <rtthread.h>
#include "bsp_init.h"
#include "stm32f4xx.h"
#include "dcd.h"
#include <ctype.h>

#define  DBG_TAG  "TinyUSB"
#define  DBG_LVL  DBG_INFO
#include <rtdbg.h>
#include <tusb.h>

#ifndef RT_USING_HEAP
/* if there is not enable heap, we should use static thread and stack. */
static rt_uint8_t tusb_stack[PKG_TINYUSB_STACK_SIZE];
static struct rt_thread tusb_thread;
#endif /* RT_USING_HEAP */


struct rt_semaphore g_dcd_sem;


int tusb_board_init(void) {
  GPIO_InitTypeDef GPIO_InitStructure;

  RCC_AHB1PeriphClockCmd(RCC_AHB1Periph_GPIOB, ENABLE);
  RCC_AHB1PeriphClockCmd(RCC_AHB1Periph_OTG_HS, ENABLE);

  GPIO_PinAFConfig(GPIOB, GPIO_PinSource14, GPIO_AF_OTG2_FS);
  GPIO_PinAFConfig(GPIOB, GPIO_PinSource15, GPIO_AF_OTG2_FS);

  GPIO_InitStructure.GPIO_Speed = GPIO_Speed_100MHz;
  GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF;
  GPIO_InitStructure.GPIO_Pin = GPIO_Pin_14 | GPIO_Pin_15;
  GPIO_Init(GPIOB, &GPIO_InitStructure);

  // no need enable irq, it will be enabled in dwc2_dcd_int_enable()
  return 0;
}

void usb_irq_enable(){
    NVIC_InitTypeDef NVIC_InitStructure;

    NVIC_PriorityGroupConfig(NVIC_PriorityGroup_1);
    NVIC_InitStructure.NVIC_IRQChannel = OTG_HS_IRQn;
    NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority = 1;
    NVIC_InitStructure.NVIC_IRQChannelSubPriority = 3;
    NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE;
    NVIC_Init(&NVIC_InitStructure);
}


static void tusb_thread_entry(void *parameter)
{
    (void) parameter;
    while (1)
    {
#if CFG_TUH_ENABLED
        tuh_task();
#endif
#if CFG_TUD_ENABLED
        tud_task();
#endif
    }
}
static void cdc_task(void *parameter);

static int init_tinyusb(void)
{
    rt_thread_t tid;
    RCC_ClocksTypeDef rcc = {0};
    RCC_GetClocksFreq(&rcc);
    rt_kprintf("TinyUSB init... \r\n");
    rt_kprintf("rcc.SYSCLK_Frequency=%d Hz\r\n", rcc.SYSCLK_Frequency);
    rt_kprintf("rcc.HCLK_Frequency=%d Hz\r\n", rcc.HCLK_Frequency);
    rt_kprintf("rcc.PCLK1_Frequency=%d Hz\r\n", rcc.PCLK1_Frequency);
    rt_kprintf("rcc.PCLK2_Frequency=%d Hz\r\n", rcc.PCLK2_Frequency);
    rt_kprintf("rcc.USBCLK_Frequency=%d Hz\r\n", rcc.USBCLK_Frequency);
    tusb_board_init();
    rt_sem_init(&g_dcd_sem, "tusb_cdc", 0, RT_IPC_FLAG_PRIO);

    //call tusb_rhport_init()
    tusb_init();
    // dcd_int_enable(TUD_OPT_RHPORT);
    usb_irq_enable();


  #ifdef RT_USING_HEAP
    tid = rt_thread_create("tusb", tusb_thread_entry, RT_NULL,
                           2048,
                           1, 10);
    if (tid == RT_NULL)
  #else
    rt_err_t result;

    tid = &tusb_thread;
    result = rt_thread_init(tid, "tusb", tusb_thread_entry, RT_NULL,
                            tusb_stack, sizeof(tusb_stack), 4, 10);
    if (result != RT_EOK)
#endif /* RT_USING_HEAP */
    {
        LOG_E("Fail to create TinyUSB thread");
        return -1;
    }

    rt_thread_startup(tid);

    tid = rt_thread_create("tusb_cdc", cdc_task, RT_NULL,
                        2048,
                        6, 10);
    rt_thread_startup(tid);

    return 0;
}
// INIT_APP_EXPORT(init_tinyusb);
extern_init(tinyusb, init_tinyusb);



static void echo_serial_port(uint8_t itf, uint8_t buf[], uint32_t count) {
  uint8_t const case_diff = 'a' - 'A';

  for (uint32_t i = 0; i < count; i++) {
    if (itf == 0) {
      // echo back 1st port as lower case
      if (isupper(buf[i])) buf[i] += case_diff;
    } else {
      // echo back 2nd port as upper case
      if (islower(buf[i])) buf[i] -= case_diff;
    }

    tud_cdc_n_write_char(itf, buf[i]);
  }
  tud_cdc_n_write_flush(itf);
}




// notify cdc task recv data
void tud_cdc_rx_cb(uint8_t itf){
  TU_LOG(2, "tud_cdc_rx_cb\r\n");
  rt_sem_release(&g_dcd_sem);
}


static void cdc_task(void *parameter) {
  TU_LOG(2, "CDC task started\r\n");
  while(1){
    rt_sem_take(&g_dcd_sem, RT_WAITING_FOREVER);
  TU_LOG(2, "tud_cdc_rx_take\r\n");
    for (uint8_t itf = 0; itf < CFG_TUD_CDC; itf++) {
      // connected() check for DTR bit
      // Most but not all terminal client set this when making connection
      // if ( tud_cdc_n_connected(itf) )
      {
        if (tud_cdc_n_available(itf)) {
          uint8_t buf[64];
          uint32_t count = tud_cdc_n_read(itf, buf, sizeof(buf));

          // echo back to both serial ports
          echo_serial_port(0, buf, count);
          echo_serial_port(1, buf, count);
        }

      }
    }
  }
}






#endif /*__RTTHREAD__*/