text: /**************************************************************************//**
   * @file     main.c
   * @version  V3.00
   * @brief    This sample demonstrates OTG HNP.
   *           This sample needs two M460 boards. One is as Host, the other is as Device.
   *
   * @copyright SPDX-License-Identifier: Apache-2.0
   * @copyright Copyright (C) 2021 Nuvoton Technology Corp. All rights reserved.
  *****************************************************************************/
  #include <stdio.h>
  #include <string.h>
  
  #include "NuMicro.h"
  
  #include "usb.h"
  #include "hub.h"
  #include "usbh_lib.h"
  #include "usbh_hid.h"
  #include "hid_mouse.h"
  
  #ifdef __ICCARM__
  #pragma data_alignment=32
  uint8_t  g_buff_pool[1024];
  #else
  uint8_t   g_buff_pool[1024] __attribute__((aligned(32)));
  #endif
  
  HID_DEV_T   *g_hid_list[CONFIG_HID_MAX_DEV];
  UDEV_T *gOTG_Dev_pet;
  
  uint8_t volatile gStartHNP = 0;
  uint8_t volatile otg_role_change = 0;
  uint32_t volatile intcount = 0;
  volatile uint32_t  g_tick_cnt;
  
  void SysTick_Handler(void)
  {
      g_tick_cnt++;
  }
  
  void enable_sys_tick(int ticks_per_second)
  {
      g_tick_cnt = 0;
      if(SysTick_Config(SystemCoreClock / ticks_per_second))
      {
          /* Setup SysTick Timer for 1 second interrupts  */
          printf("Set system tick error!!\n");
          while(1);
      }
  }
  
  uint32_t get_ticks()
  {
      return g_tick_cnt;
  }
  
  /*
   *  USB device connect callback function.
   *  User invokes usbh_pooling_hubs() to let USB core able to scan and handle events of
   *  HSUSBH port, USBH port, and USB hub device ports. Once a new device connected, it
   *  will be detected and enumerated in the call to usbh_pooling_hubs(). This callback
   *  will be invoked from USB core once a newly connected device was successfully enumerated.
   */
  void  connect_func(struct udev_t *udev, int param)
  {
      struct hub_dev_t *parent;
      int    i;
  
      gOTG_Dev_pet = udev;
      parent = udev->parent;
  
      printf("Device [0x%x,0x%x] was connected.\n",
             udev->descriptor.idVendor, udev->descriptor.idProduct);
      printf("    Speed:    %s-speed\n", (udev->speed == SPEED_HIGH) ? "high" : ((udev->speed == SPEED_FULL) ? "full" : "low"));
      printf("    Location: ");
  
      if(parent == NULL)
      {
          if(udev->port_num == 1)
              printf("USB 2.0 port\n");
          else
              printf("USB 1.1 port\n");
      }
      else
      {
          if(parent->pos_id[0] == '1')
              printf("USB 2.0 port");
          else
              printf("USB 1.1 port");
  
          for(i = 1; parent->pos_id[i] != 0; i++)
          {
              printf(" => Hub port %c", parent->pos_id[i]);
          }
  
          printf(" => Hub port %d\n", udev->port_num);
  
          printf("\n");
      }
      printf("\n");
  }
  
  
  /*
   *  USB device disconnect callback function.
   *  User invokes usbh_pooling_hubs() to let USB core able to scan and handle events of
   *  HSUSBH port, USBH port, and USB hub device ports. Once a device was disconnected, it
   *  will be detected and removed in the call to usbh_pooling_hubs(). This callback
   *  will be invoked from USB core prior to remove that device.
   */
  void  disconnect_func(struct udev_t *udev, int param)
  {
      printf("Device [0x%x,0x%x] was disconnected.\n",
             udev->descriptor.idVendor, udev->descriptor.idProduct);
  }
  
  /*
   *  This function is necessary for USB Host library.
   */
  void delay_us(int usec)
  {
      /*
       *  Configure Timer0, clock source from XTL_12M. Prescale 12
       */
      /* TIMER0 clock from HXT */
      CLK->CLKSEL1 = (CLK->CLKSEL1 & (~CLK_CLKSEL1_TMR0SEL_Msk)) | CLK_CLKSEL1_TMR0SEL_HXT;
      CLK->APBCLK0 |= CLK_APBCLK0_TMR0CKEN_Msk;
      TIMER0->CTL = 0;        /* disable timer */
      TIMER0->INTSTS = 0x3;   /* write 1 to clear for safty */
      TIMER0->CMP = usec;
      TIMER0->CTL = (11 << TIMER_CTL_PSC_Pos) | TIMER_ONESHOT_MODE | TIMER_CTL_CNTEN_Msk;
  
      while(!TIMER0->INTSTS);
  }
  
  void  dump_buff_hex(uint8_t *pucBuff, int nBytes)
  {
      int     nIdx, i;
  
      nIdx = 0;
      while(nBytes > 0)
      {
          printf("0x%04X  ", nIdx);
          for(i = 0; (i < 16) && (nBytes > 0); i++)
          {
              printf("%02x ", pucBuff[nIdx + i]);
              nBytes--;
          }
          nIdx += 16;
          printf("\n");
      }
      printf("\n");
  }
  
  
  int  is_a_new_hid_device(HID_DEV_T *hdev)
  {
      int    i;
      for(i = 0; i < CONFIG_HID_MAX_DEV; i++)
      {
          if((g_hid_list[i] != NULL) && (g_hid_list[i] == hdev) &&
                  (g_hid_list[i]->uid == hdev->uid))
              return 0;
      }
      return 1;
  }
  
  void update_hid_device_list(HID_DEV_T *hdev)
  {
      int  i = 0;
      memset(g_hid_list, 0, sizeof(g_hid_list));
      while((i < CONFIG_HID_MAX_DEV) && (hdev != NULL))
      {
          g_hid_list[i++] = hdev;
          hdev = hdev->next;
      }
  }
  
  void  int_read_callback(HID_DEV_T *hdev, uint16_t ep_addr, int status, uint8_t *rdata, uint32_t data_len)
  {
      /*
       *  USB host HID driver notify user the transfer status via <status> parameter. If the
       *  If <status> is 0, the USB transfer is fine. If <status> is not zero, this interrupt in
       *  transfer failed and HID driver will stop this pipe. It can be caused by USB transfer error
       *  or device disconnected.
       */
      if(status < 0)
      {
          printf("Interrupt in transfer failed! status: %d\n", status);
          return;
      }
  //    printf("Device [0x%x,0x%x] ep 0x%x, %d bytes received =>\n",
  //           hdev->idVendor, hdev->idProduct, ep_addr, data_len);
  //    dump_buff_hex(rdata, data_len);
  
      intcount++;
  }
  
  int  init_hid_device(HID_DEV_T *hdev)
  {
      uint8_t   *data_buff;
      int       i, ret;
  
      data_buff = (uint8_t *)((uint32_t)g_buff_pool);
  
      printf("\n\n==================================\n");
      printf("  Init HID device : 0x%x\n", (int)hdev);
      printf("  VID: 0x%x, PID: 0x%x\n\n", hdev->idVendor, hdev->idProduct);
  
      ret = usbh_hid_get_report_descriptor(hdev, data_buff, 1024);
      if(ret > 0)
      {
          printf("\nDump report descriptor =>\n");
          dump_buff_hex(data_buff, ret);
      }
  
      /*
       *  Example: GET_PROTOCOL request.
       */
      ret = usbh_hid_get_protocol(hdev, data_buff);
      //printf("[GET_PROTOCOL] ret = %d, protocol = %d\n", ret, data_buff[0]);
  
      /*
       *  Example: SET_PROTOCOL request.
       */
      ret = usbh_hid_set_protocol(hdev, data_buff[0]);
      //printf("[SET_PROTOCOL] ret = %d, protocol = %d\n", ret, data_buff[0]);
  
      /*
       *  Example: GET_REPORT request on report ID 0x1, report type FEATURE.
       */
      ret = usbh_hid_get_report(hdev, RT_FEATURE, 0x1, data_buff, 64);
      if(ret > 0)
      {
          printf("[GET_REPORT] Data => ");
          for(i = 0; i < ret; i++)
              printf("%02x ", data_buff[i]);
          printf("\n");
      }
  
      gStartHNP = 1;
  
      printf("\nUSBH_HidStartIntReadPipe...\n");
      ret = usbh_hid_start_int_read(hdev, 0, int_read_callback);
      if(ret != HID_RET_OK)
          printf("usbh_hid_start_int_read failed! %d\n", ret);
      else
          printf("Interrupt in transfer started...\n");
  
      return 0;
  }
  
  void SYS_Init(void)
  {
      /* Unlock protected registers */
      SYS_UnlockReg();
  
      /*---------------------------------------------------------------------------------------------------------*/
      /* Init System Clock                                                                                       */
      /*---------------------------------------------------------------------------------------------------------*/
  
      /* Enable HIRC and HXT clock */
      CLK_EnableXtalRC(CLK_PWRCTL_HIRCEN_Msk | CLK_PWRCTL_HXTEN_Msk);
  
      /* Wait for HIRC and HXT clock ready */
      CLK_WaitClockReady(CLK_STATUS_HIRCSTB_Msk | CLK_STATUS_HXTSTB_Msk);
  
      /* Set PCLK0 and PCLK1 to HCLK/2 */
      CLK->PCLKDIV = (CLK_PCLKDIV_APB0DIV_DIV2 | CLK_PCLKDIV_APB1DIV_DIV2);
  
      /* Set core clock to 192MHz */
      CLK_SetCoreClock(FREQ_192MHZ);
  
      /* Enable all GPIO clock */
      CLK->AHBCLK0 |= CLK_AHBCLK0_GPACKEN_Msk | CLK_AHBCLK0_GPBCKEN_Msk | CLK_AHBCLK0_GPCCKEN_Msk | CLK_AHBCLK0_GPDCKEN_Msk |
                      CLK_AHBCLK0_GPECKEN_Msk | CLK_AHBCLK0_GPFCKEN_Msk | CLK_AHBCLK0_GPGCKEN_Msk | CLK_AHBCLK0_GPHCKEN_Msk;
      CLK->AHBCLK1 |= CLK_AHBCLK1_GPICKEN_Msk | CLK_AHBCLK1_GPJCKEN_Msk;
  
      /* Enable UART0 module clock */
      CLK_EnableModuleClock(UART0_MODULE);
  
      /* Select UART0 module clock source as HIRC and UART0 module clock divider as 1 */
      CLK_SetModuleClock(UART0_MODULE, CLK_CLKSEL1_UART0SEL_HIRC, CLK_CLKDIV0_UART0(1));
  
      /* Select On-The-Go device */
      SYS->USBPHY = SYS_USBPHY_HSUSBEN_Msk | (0x3 << SYS_USBPHY_HSUSBROLE_Pos) | SYS_USBPHY_USBEN_Msk | SYS_USBPHY_SBO_Msk | (0x3 << SYS_USBPHY_USBROLE_Pos);
      delay_us(20);
      SYS->USBPHY |= SYS_USBPHY_HSUSBACT_Msk;
  
      /* Select USB clock divider as 2 */
      CLK->CLKDIV0 = (CLK->CLKDIV0 & ~CLK_CLKDIV0_USBDIV_Msk) | CLK_CLKDIV0_USB(2);
  
      /* Enable USBH module clock */
      CLK_EnableModuleClock(USBH_MODULE);
  
      /* Enable HSUSBD module clock */
      CLK_EnableModuleClock(HSUSBD_MODULE);
  
      /* Enable HSOTG module clock */
      CLK_EnableModuleClock(HSOTG_MODULE);
  
      /*---------------------------------------------------------------------------------------------------------*/
      /* Init I/O Multi-function                                                                                 */
      /*---------------------------------------------------------------------------------------------------------*/
  
      /* Set multi-function pins for UART0 RXD and TXD */
      SET_UART0_RXD_PB12();
      SET_UART0_TXD_PB13();
  
      /* USB_VBUS_EN (USB 1.1 VBUS power enable pin) multi-function pin - PB.15     */
      SET_USB_VBUS_EN_PB15();
  
      /* USB_VBUS_ST (USB 1.1 over-current detect pin) multi-function pin - PC.14   */
      SET_USB_VBUS_ST_PC14();
  
      /* HSUSB_VBUS_EN (USB 2.0 VBUS power enable pin) multi-function pin - PB.10   */
      SET_HSUSB_VBUS_EN_PB10();
  
      /* HSUSB_VBUS_ST (USB 2.0 over-current detect pin) multi-function pin - PB.11 */
      SET_HSUSB_VBUS_ST_PB11();
  
      /* USB 1.1 port multi-function pin VBUS, D+, D-, and ID pins */
      SET_USB_VBUS_PA12();
      SET_USB_D_N_PA13();
      SET_USB_D_P_PA14();
      SET_USB_OTG_ID_PA15();
  
      /* Lock protected registers */
      SYS_LockReg();
  }
  
  void OTG_SetFeature(uint32_t value)
  {
      uint32_t  read_len;
      /* 0x3 - b_hnp_enable, 0x4 - a_hnp_support */
      /* set feature */
      usbh_ctrl_xfer(gOTG_Dev_pet, REQ_TYPE_OUT | REQ_TYPE_STD_DEV | REQ_TYPE_TO_DEV,
                     USB_REQ_SET_FEATURE, value, 0, 0,
                     NULL, &read_len, 300);
  }
  
  /**
    * @brief  USBOTG20_IRQHandler, HSOTG interrupt handler.
    * @param  None.
    * @retval None.
    */
  void USBOTG20_IRQHandler(void)
  {
      __IO uint32_t reg, en, i;
  
      en = HSOTG->INTEN;
      reg = HSOTG->INTSTS;
  
      if(reg & en & HSOTG_INTSTS_ROLECHGIF_Msk)
      {
          printf("[Role Change]\n");
          HSOTG_CLR_INT_FLAG(HSOTG_INTSTS_ROLECHGIF_Msk);
      }
  
      if(reg & en & HSOTG_INTSTS_GOIDLEIF_Msk)
      {
          printf("[Go Idle] 0x%x\n", HSOTG->STATUS);
          HSOTG_CLR_INT_FLAG(HSOTG_INTSTS_GOIDLEIF_Msk);
          otg_role_change = 0;
      }
  
      if(reg & en & HSOTG_INTSTS_IDCHGIF_Msk)
      {
          printf("[ID change 0x%x]\n", HSOTG->STATUS);
          HSOTG_CLR_INT_FLAG(HSOTG_INTSTS_IDCHGIF_Msk);
          if((HSOTG->STATUS & HSOTG_STATUS_IDSTS_Msk) == 0)
              HSOTG->CTL |= HSOTG_CTL_BUSREQ_Msk;
      }
  
      if(reg & en & HSOTG_INTSTS_VBEIF_Msk)
      {
          printf("[VBUS Err]\n");
          HSOTG_CLR_INT_FLAG(HSOTG_INTSTS_VBEIF_Msk);
      }
  
      if(reg & en & HSOTG_INTSTS_SRPFIF_Msk)
      {
          printf("[SRP Fail]\n");
          HSOTG_CLR_INT_FLAG(HSOTG_INTSTS_SRPFIF_Msk);
      }
  
      if(reg & en & HSOTG_INTSTS_HNPFIF_Msk)
      {
          printf("[HNP Fail]\n");
          HSOTG_CLR_INT_FLAG(HSOTG_INTSTS_HNPFIF_Msk);
          otg_role_change = 0;
      }
  
      if(reg & en & HSOTG_INTSTS_SRPDETIF_Msk)
      {
          printf("[SRP Detect]\n");
          HSOTG_CLR_INT_FLAG(HSOTG_INTSTS_SRPDETIF_Msk);
          for(i = 0; i < 10000; i++);
          HSOTG->CTL |= HSOTG_CTL_BUSREQ_Msk;
      }
  
      if(reg & en & HSOTG_INTSTS_HOSTIF_Msk)
      {
          printf("[Act as Host]\n");
          HSOTG_DISABLE_INT(HSOTG_INTEN_HOSTIEN_Msk);
          HSOTG_CLR_INT_FLAG(HSOTG_INTSTS_HOSTIF_Msk);
          if(HSOTG->STATUS & 0x80)
          {
              if(otg_role_change == 3)
                  otg_role_change = 4;
              else
                  otg_role_change = 2;
          }
      }
  
      if(reg & en & HSOTG_INTSTS_PDEVIF_Msk)
      {
          printf("[Act as Peripheral]\n");
          HSOTG_DISABLE_INT(HSOTG_INTEN_PDEVIEN_Msk);
          HSOTG_CLR_INT_FLAG(HSOTG_INTSTS_PDEVIF_Msk);
          if(HSOTG->STATUS & 0x40)
          {
              if(otg_role_change == 2)
                  otg_role_change = 4;
              else
                  otg_role_change = 3;
          }
      }
  }
  
  int32_t main(void)
  {
      HID_DEV_T    *hdev, *hdev_list;
  
      SYS_Init();                        /* Init System, IP clock and multi-function I/O */
      UART_Open(UART0, 115200);          /* Initialize UART0 */
      enable_sys_tick(100);
  
      printf("\n\n");
      printf("+------------------------------+\n");
      printf("|                              |\n");
      printf("|     USB HSOTG HNP sample     |\n");
      printf("|                              |\n");
      printf("+------------------------------+\n");
  
      HSOTG_ENABLE_PHY();
      HSOTG_ENABLE_ID_DETECT();
      NVIC_EnableIRQ(USBOTG20_IRQn);
      delay_us(1000);
  
      /* clear interrupt and enable relative interrupts */
      HSOTG_ENABLE_INT(HSOTG_INTEN_VBEIEN_Msk | HSOTG_INTEN_SRPFIEN_Msk | HSOTG_INTEN_HNPFIEN_Msk | HSOTG_INTEN_GOIDLEIEN_Msk |
                       HSOTG_INTEN_SRPDETIEN_Msk | HSOTG_INTEN_IDCHGIEN_Msk | HSOTG_INTEN_ROLECHGIEN_Msk);
  
      usbh_core_init();
      usbh_install_conn_callback(connect_func, disconnect_func);
      usbh_hid_init();
      memset(g_hid_list, 0, sizeof(g_hid_list));
  
      while(1)
      {
          if(HSOTG_GET_STATUS(HSOTG_STATUS_IDSTS_Msk))   /* B-device */
          {
              if(HSOTG_GET_STATUS(HSOTG_STATUS_BVLD_Msk))   /* plug-in */
              {
                  printf("B-device\n");
                  /* wait role change to host */
                  HSOTG_ENABLE_INT(HSOTG_INTEN_HOSTIEN_Msk);
  
                  HSUSBD_Open(&gsHSInfo, HID_ClassRequest, NULL);
                  /* Endpoint configuration */
                  HID_Init();
                  HSOTG_ENABLE();
                  HSOTG_ENABLE_PHY();
                  HSUSBD_Start();
                  NVIC_EnableIRQ(USBD20_IRQn);
  
                  while(1)
                  {
                      HID_UpdateMouseData();
                      if(otg_role_change)
                      {
                          printf("Role change: B->A  %d\n", otg_role_change);
                          break;
                      }
                  }
              }
          }
          else
          {
              printf("A-device\n");
              HSOTG_CLR_INT_FLAG(HSOTG_INTSTS_HOSTIF_Msk);
              HSOTG_ENABLE_INT(HSOTG_INTEN_PDEVIEN_Msk);
              HSOTG_ENABLE();
              usbh_pooling_hubs();
              while(1)
              {
                  if(usbh_pooling_hubs())
                  {
                      hdev_list = usbh_hid_get_device_list();
                      hdev = hdev_list;
                      while(hdev != NULL)
                      {
                          if(is_a_new_hid_device(hdev))
                          {
                              init_hid_device(hdev);
                          }
                          hdev = hdev->next;
                      }
                      update_hid_device_list(hdev_list);
                  }
  
                  if(intcount > 3)
                  {
                      usbh_hid_stop_int_read(hdev, 0);
                      delay_us(2000);
                      intcount = 0;
                      gStartHNP = 1;
                  }
  
                  if(gStartHNP)
                  {
                      printf("do HNP...\n");
                      /* do HNP */
                      OTG_SetFeature(0x3);
                      delay_us(100000);
                      gStartHNP = 0;
                      /* port suspend */
                      HSOTG->CTL |= HSOTG_CTL_HNPREQEN_Msk;
                      HSOTG->CTL &= ~HSOTG_CTL_BUSREQ_Msk;
                      usbh_suspend();
                      printf("A suspend\n");
                      while(1)
                      {
                          if(otg_role_change)
                          {
                              printf("Role change: A->B  %d\n", otg_role_change);
                              break;
                          }
                      }
                  }
  
                  if(otg_role_change)
                  {
                      break;
                  }
              }
          }
  
          if(otg_role_change == 2)    /* b -> a */
          {
              HSOTG_CLR_INT_FLAG(HSOTG_INTSTS_HOSTIF_Msk | HSOTG_INTSTS_PDEVIF_Msk);
              HSOTG_ENABLE_INT(HSOTG_INTEN_PDEVIEN_Msk);
              HSOTG_ENABLE();
              gStartHNP = intcount = 0;
              while(1)
              {
                  if(usbh_pooling_hubs())
                  {
                      hdev_list = usbh_hid_get_device_list();
                      hdev = hdev_list;
                      while(hdev != NULL)
                      {
                          if(is_a_new_hid_device(hdev))
                          {
                              init_hid_device(hdev);
                          }
                          hdev = hdev->next;
                      }
                      update_hid_device_list(hdev_list);
                  }
  
                  if(intcount > 5)
                  {
                      usbh_hid_stop_int_read(hdev, 0);
                      gStartHNP = 1;
                      intcount = 0;
                  }
  
                  if(gStartHNP)
                  {
                      printf("\n\nwaiting...\n\n");
                      HSOTG->CTL &= ~HSOTG_CTL_BUSREQ_Msk;
                      gStartHNP = 0;
                      delay_us(5000);
                  }
  
                  if(otg_role_change == 4)
                  {
                      printf("Role change: A->B  %d\n", otg_role_change);
                      break;
                  }
              }
          }
  
          if(otg_role_change == 3)    /* a -> b */
          {
              /* wait role change to host */
              HSOTG_CLR_INT_FLAG(HSOTG_INTSTS_HOSTIF_Msk | HSOTG_INTSTS_PDEVIF_Msk);
              HSOTG_ENABLE_INT(HSOTG_INTEN_HOSTIEN_Msk);
  
              HSUSBD_Open(&gsHSInfo, HID_ClassRequest, NULL);
              /* Endpoint configuration */
              HID_Init();
              HSUSBD_Start();
              NVIC_EnableIRQ(USBD20_IRQn);
  
              while(1)
              {
                  HID_UpdateMouseData();
                  if(otg_role_change == 4)
                  {
                      printf("Role change: B->A  %d\n", otg_role_change);
                      break;
                  }
              }
          }
          if(otg_role_change == 4)
              break;
      }
      printf("\n finish HNP testing ..\n");
      while(1);
  }
  