refactor nrf5x hal
This commit is contained in:
parent
09b019f9c7
commit
3b423f3901
|
@ -57,13 +57,24 @@
|
||||||
/*------------------------------------------------------------------*/
|
/*------------------------------------------------------------------*/
|
||||||
/* MACRO TYPEDEF CONSTANT ENUM
|
/* MACRO TYPEDEF CONSTANT ENUM
|
||||||
*------------------------------------------------------------------*/
|
*------------------------------------------------------------------*/
|
||||||
|
|
||||||
#define USB_NVIC_PRIO 7
|
#define USB_NVIC_PRIO 7
|
||||||
|
|
||||||
|
// TODO switch to use nrfx_power.h in sdk15
|
||||||
|
enum
|
||||||
|
{
|
||||||
|
NRFX_POWER_USB_EVT_DETECTED,
|
||||||
|
NRFX_POWER_USB_EVT_REMOVED,
|
||||||
|
NRFX_POWER_USB_EVT_READY
|
||||||
|
};
|
||||||
|
|
||||||
/*------------------------------------------------------------------*/
|
/*------------------------------------------------------------------*/
|
||||||
/* FUNCTION DECLARATION
|
/* FUNCTION DECLARATION
|
||||||
*------------------------------------------------------------------*/
|
*------------------------------------------------------------------*/
|
||||||
void power_usb_event_handler(uint32_t event);
|
void tusb_hal_nrf_power_event(uint32_t event);
|
||||||
|
|
||||||
|
/*------------------------------------------------------------------*/
|
||||||
|
/* HFCLK helper
|
||||||
|
*------------------------------------------------------------------*/
|
||||||
|
|
||||||
// check if SD is present and enabled
|
// check if SD is present and enabled
|
||||||
static bool is_sd_enabled(void)
|
static bool is_sd_enabled(void)
|
||||||
|
@ -77,65 +88,6 @@ static bool is_sd_enabled(void)
|
||||||
return sd_en;
|
return sd_en;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
bool tusb_hal_init(void)
|
|
||||||
{
|
|
||||||
#ifdef SOFTDEVICE_PRESENT
|
|
||||||
if ( is_sd_enabled() )
|
|
||||||
{
|
|
||||||
sd_power_usbdetected_enable(true);
|
|
||||||
sd_power_usbpwrrdy_enable(true);
|
|
||||||
sd_power_usbremoved_enable(true);
|
|
||||||
|
|
||||||
// USB power may already be ready at this time -> no event generated
|
|
||||||
// We need to execute the hanlder based on the status
|
|
||||||
uint32_t usb_reg;
|
|
||||||
sd_power_usbregstatus_get(&usb_reg);
|
|
||||||
|
|
||||||
if (usb_reg & POWER_USBREGSTATUS_VBUSDETECT_Msk )
|
|
||||||
{
|
|
||||||
power_usb_event_handler(NRF_EVT_POWER_USB_DETECTED);
|
|
||||||
}
|
|
||||||
|
|
||||||
if (usb_reg & POWER_USBREGSTATUS_OUTPUTRDY_Msk )
|
|
||||||
{
|
|
||||||
power_usb_event_handler(NRF_EVT_POWER_USB_POWER_READY);
|
|
||||||
}
|
|
||||||
|
|
||||||
// power_usb_event_handler must be called by SOC event hanlder
|
|
||||||
return true;
|
|
||||||
}else
|
|
||||||
#endif
|
|
||||||
{
|
|
||||||
#if 0
|
|
||||||
// USB Power detection
|
|
||||||
const nrf_drv_power_usbevt_config_t config =
|
|
||||||
{
|
|
||||||
.handler = (nrf_drv_power_usb_event_handler_t) power_usb_event_handler
|
|
||||||
};
|
|
||||||
return ( NRF_SUCCESS == nrf_drv_power_usbevt_init(&config) );
|
|
||||||
#else
|
|
||||||
return true;
|
|
||||||
#endif
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
void tusb_hal_int_enable(uint8_t rhport)
|
|
||||||
{
|
|
||||||
(void) rhport;
|
|
||||||
NVIC_EnableIRQ(USBD_IRQn);
|
|
||||||
}
|
|
||||||
|
|
||||||
void tusb_hal_int_disable(uint8_t rhport)
|
|
||||||
{
|
|
||||||
(void) rhport;
|
|
||||||
NVIC_DisableIRQ(USBD_IRQn);
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
/*------------------------------------------------------------------*/
|
|
||||||
/* HFCLK helper
|
|
||||||
*------------------------------------------------------------------*/
|
|
||||||
static bool hfclk_running(void)
|
static bool hfclk_running(void)
|
||||||
{
|
{
|
||||||
#ifdef SOFTDEVICE_PRESENT
|
#ifdef SOFTDEVICE_PRESENT
|
||||||
|
@ -180,31 +132,72 @@ static void hfclk_disable(void)
|
||||||
nrf_clock_task_trigger(NRF_CLOCK_TASK_HFCLKSTOP);
|
nrf_clock_task_trigger(NRF_CLOCK_TASK_HFCLKSTOP);
|
||||||
}
|
}
|
||||||
|
|
||||||
/*------------------------------------------------------------------*/
|
|
||||||
/* Controller Start up Sequence (USBD 51.4 specs)
|
|
||||||
*------------------------------------------------------------------*/
|
|
||||||
void power_usb_event_handler(uint32_t event)
|
|
||||||
{
|
|
||||||
uint32_t POWER_DETECT, POWER_READY, POWER_REMOVE;
|
|
||||||
|
|
||||||
|
/*------------------------------------------------------------------*/
|
||||||
|
/* TUSB HAL
|
||||||
|
*------------------------------------------------------------------*/
|
||||||
|
bool tusb_hal_init(void)
|
||||||
|
{
|
||||||
#ifdef SOFTDEVICE_PRESENT
|
#ifdef SOFTDEVICE_PRESENT
|
||||||
if ( is_sd_enabled() )
|
if ( is_sd_enabled() )
|
||||||
{
|
{
|
||||||
POWER_DETECT = NRF_EVT_POWER_USB_DETECTED;
|
sd_power_usbdetected_enable(true);
|
||||||
POWER_READY = NRF_EVT_POWER_USB_POWER_READY;
|
sd_power_usbpwrrdy_enable(true);
|
||||||
POWER_REMOVE = NRF_EVT_POWER_USB_REMOVED;
|
sd_power_usbremoved_enable(true);
|
||||||
|
|
||||||
|
// USB power may already be ready at this time -> no event generated
|
||||||
|
// We need to execute the hanlder based on the status
|
||||||
|
uint32_t usb_reg;
|
||||||
|
sd_power_usbregstatus_get(&usb_reg);
|
||||||
|
|
||||||
|
if (usb_reg & POWER_USBREGSTATUS_VBUSDETECT_Msk )
|
||||||
|
{
|
||||||
|
tusb_hal_nrf_power_event(NRF_EVT_POWER_USB_DETECTED);
|
||||||
|
}
|
||||||
|
|
||||||
|
if (usb_reg & POWER_USBREGSTATUS_OUTPUTRDY_Msk )
|
||||||
|
{
|
||||||
|
tusb_hal_nrf_power_event(NRF_EVT_POWER_USB_POWER_READY);
|
||||||
|
}
|
||||||
|
|
||||||
|
// tusb_hal_nrf_power_event must be called by SOC event hanlder
|
||||||
|
return true;
|
||||||
}else
|
}else
|
||||||
#endif
|
#endif
|
||||||
{
|
{
|
||||||
#if 0
|
#if 0
|
||||||
POWER_DETECT = NRF_DRV_POWER_USB_EVT_DETECTED;
|
// USB Power detection
|
||||||
POWER_READY = NRF_DRV_POWER_USB_EVT_READY;
|
const nrf_drv_power_usbevt_config_t config =
|
||||||
POWER_REMOVE = NRF_DRV_POWER_USB_EVT_REMOVED;
|
|
||||||
#endif
|
|
||||||
}
|
|
||||||
|
|
||||||
if ( POWER_DETECT == event )
|
|
||||||
{
|
{
|
||||||
|
.handler = (nrf_drv_power_usb_event_handler_t) tusb_hal_nrf_power_event
|
||||||
|
};
|
||||||
|
return ( NRF_SUCCESS == nrf_drv_power_usbevt_init(&config) );
|
||||||
|
#else
|
||||||
|
return true;
|
||||||
|
#endif
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
void tusb_hal_int_enable(uint8_t rhport)
|
||||||
|
{
|
||||||
|
(void) rhport;
|
||||||
|
NVIC_EnableIRQ(USBD_IRQn);
|
||||||
|
}
|
||||||
|
|
||||||
|
void tusb_hal_int_disable(uint8_t rhport)
|
||||||
|
{
|
||||||
|
(void) rhport;
|
||||||
|
NVIC_DisableIRQ(USBD_IRQn);
|
||||||
|
}
|
||||||
|
|
||||||
|
/*------------------------------------------------------------------*/
|
||||||
|
/* Controller Start up Sequence (USBD 51.4 specs)
|
||||||
|
*------------------------------------------------------------------*/
|
||||||
|
void tusb_hal_nrf_power_event(uint32_t event)
|
||||||
|
{
|
||||||
|
switch ( event )
|
||||||
|
{
|
||||||
|
case NRFX_POWER_USB_EVT_DETECTED:
|
||||||
if ( !NRF_USBD->ENABLE )
|
if ( !NRF_USBD->ENABLE )
|
||||||
{
|
{
|
||||||
/* Prepare for READY event receiving */
|
/* Prepare for READY event receiving */
|
||||||
|
@ -215,7 +208,7 @@ void power_usb_event_handler(uint32_t event)
|
||||||
|
|
||||||
if (nrf_drv_usbd_errata_187())
|
if (nrf_drv_usbd_errata_187())
|
||||||
{
|
{
|
||||||
// CRITICAL_REGION_ENTER();
|
// CRITICAL_REGION_ENTER();
|
||||||
if (*((volatile uint32_t *)(0x4006EC00)) == 0x00000000)
|
if (*((volatile uint32_t *)(0x4006EC00)) == 0x00000000)
|
||||||
{
|
{
|
||||||
*((volatile uint32_t *)(0x4006EC00)) = 0x00009375;
|
*((volatile uint32_t *)(0x4006EC00)) = 0x00009375;
|
||||||
|
@ -226,12 +219,12 @@ void power_usb_event_handler(uint32_t event)
|
||||||
{
|
{
|
||||||
*((volatile uint32_t *)(0x4006ED14)) = 0x00000003;
|
*((volatile uint32_t *)(0x4006ED14)) = 0x00000003;
|
||||||
}
|
}
|
||||||
// CRITICAL_REGION_EXIT();
|
// CRITICAL_REGION_EXIT();
|
||||||
}
|
}
|
||||||
|
|
||||||
if (nrf_drv_usbd_errata_171())
|
if (nrf_drv_usbd_errata_171())
|
||||||
{
|
{
|
||||||
// CRITICAL_REGION_ENTER();
|
// CRITICAL_REGION_ENTER();
|
||||||
if (*((volatile uint32_t *)(0x4006EC00)) == 0x00000000)
|
if (*((volatile uint32_t *)(0x4006EC00)) == 0x00000000)
|
||||||
{
|
{
|
||||||
*((volatile uint32_t *)(0x4006EC00)) = 0x00009375;
|
*((volatile uint32_t *)(0x4006EC00)) = 0x00009375;
|
||||||
|
@ -242,7 +235,7 @@ void power_usb_event_handler(uint32_t event)
|
||||||
{
|
{
|
||||||
*((volatile uint32_t *)(0x4006EC14)) = 0x000000C0;
|
*((volatile uint32_t *)(0x4006EC14)) = 0x000000C0;
|
||||||
}
|
}
|
||||||
// CRITICAL_REGION_EXIT();
|
// CRITICAL_REGION_EXIT();
|
||||||
}
|
}
|
||||||
|
|
||||||
nrf_usbd_enable();
|
nrf_usbd_enable();
|
||||||
|
@ -250,9 +243,9 @@ void power_usb_event_handler(uint32_t event)
|
||||||
// Enable HFCLK
|
// Enable HFCLK
|
||||||
hfclk_enable();
|
hfclk_enable();
|
||||||
}
|
}
|
||||||
}
|
break;
|
||||||
else if ( POWER_READY == event )
|
|
||||||
{
|
case NRFX_POWER_USB_EVT_READY:
|
||||||
/* Waiting for USBD peripheral enabled */
|
/* Waiting for USBD peripheral enabled */
|
||||||
while ( !(NRF_USBD_EVENTCAUSE_READY_MASK & NRF_USBD->EVENTCAUSE) ) { }
|
while ( !(NRF_USBD_EVENTCAUSE_READY_MASK & NRF_USBD->EVENTCAUSE) ) { }
|
||||||
nrf_usbd_eventcause_clear(NRF_USBD_EVENTCAUSE_READY_MASK);
|
nrf_usbd_eventcause_clear(NRF_USBD_EVENTCAUSE_READY_MASK);
|
||||||
|
@ -260,7 +253,7 @@ void power_usb_event_handler(uint32_t event)
|
||||||
|
|
||||||
if (nrf_drv_usbd_errata_171())
|
if (nrf_drv_usbd_errata_171())
|
||||||
{
|
{
|
||||||
// CRITICAL_REGION_ENTER();
|
// CRITICAL_REGION_ENTER();
|
||||||
if (*((volatile uint32_t *)(0x4006EC00)) == 0x00000000)
|
if (*((volatile uint32_t *)(0x4006EC00)) == 0x00000000)
|
||||||
{
|
{
|
||||||
*((volatile uint32_t *)(0x4006EC00)) = 0x00009375;
|
*((volatile uint32_t *)(0x4006EC00)) = 0x00009375;
|
||||||
|
@ -272,12 +265,12 @@ void power_usb_event_handler(uint32_t event)
|
||||||
*((volatile uint32_t *)(0x4006EC14)) = 0x00000000;
|
*((volatile uint32_t *)(0x4006EC14)) = 0x00000000;
|
||||||
}
|
}
|
||||||
|
|
||||||
// CRITICAL_REGION_EXIT();
|
// CRITICAL_REGION_EXIT();
|
||||||
}
|
}
|
||||||
|
|
||||||
if (nrf_drv_usbd_errata_187())
|
if (nrf_drv_usbd_errata_187())
|
||||||
{
|
{
|
||||||
// CRITICAL_REGION_ENTER();
|
// CRITICAL_REGION_ENTER();
|
||||||
if (*((volatile uint32_t *)(0x4006EC00)) == 0x00000000)
|
if (*((volatile uint32_t *)(0x4006EC00)) == 0x00000000)
|
||||||
{
|
{
|
||||||
*((volatile uint32_t *)(0x4006EC00)) = 0x00009375;
|
*((volatile uint32_t *)(0x4006EC00)) = 0x00009375;
|
||||||
|
@ -288,7 +281,7 @@ void power_usb_event_handler(uint32_t event)
|
||||||
{
|
{
|
||||||
*((volatile uint32_t *)(0x4006ED14)) = 0x00000000;
|
*((volatile uint32_t *)(0x4006ED14)) = 0x00000000;
|
||||||
}
|
}
|
||||||
// CRITICAL_REGION_EXIT();
|
// CRITICAL_REGION_EXIT();
|
||||||
}
|
}
|
||||||
|
|
||||||
if ( nrf_drv_usbd_errata_166() )
|
if ( nrf_drv_usbd_errata_166() )
|
||||||
|
@ -320,9 +313,9 @@ void power_usb_event_handler(uint32_t event)
|
||||||
|
|
||||||
// Enable pull up
|
// Enable pull up
|
||||||
nrf_usbd_pullup_enable();
|
nrf_usbd_pullup_enable();
|
||||||
}
|
break;
|
||||||
else if (POWER_REMOVE == event )
|
|
||||||
{
|
case NRFX_POWER_USB_EVT_REMOVED:
|
||||||
if ( NRF_USBD->ENABLE )
|
if ( NRF_USBD->ENABLE )
|
||||||
{
|
{
|
||||||
// Abort all transfers
|
// Abort all transfers
|
||||||
|
@ -339,9 +332,9 @@ void power_usb_event_handler(uint32_t event)
|
||||||
nrf_usbd_disable();
|
nrf_usbd_disable();
|
||||||
hfclk_disable();
|
hfclk_disable();
|
||||||
}
|
}
|
||||||
}
|
break;
|
||||||
else
|
|
||||||
{
|
default: break;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
Loading…
Reference in New Issue