mirror of
https://bitbucket.org/librepilot/librepilot.git
synced 2024-11-30 08:24:11 +01:00
a2d8544931
to make the flight code compile again. Needs careful review, particularly all the fixes for the signed vs unsigned comparisons. +review OPReview-459
293 lines
8.6 KiB
C
293 lines
8.6 KiB
C
/******************** (C) COPYRIGHT 2010 STMicroelectronics ********************
|
|
* File Name : usb_pwr.c
|
|
* Author : MCD Application Team
|
|
* Version : V3.2.1
|
|
* Date : 07/05/2010
|
|
* Description : Connection/disconnection & power management
|
|
********************************************************************************
|
|
* THE PRESENT FIRMWARE WHICH IS FOR GUIDANCE ONLY AIMS AT PROVIDING CUSTOMERS
|
|
* WITH CODING INFORMATION REGARDING THEIR PRODUCTS IN ORDER FOR THEM TO SAVE TIME.
|
|
* AS A RESULT, STMICROELECTRONICS SHALL NOT BE HELD LIABLE FOR ANY DIRECT,
|
|
* INDIRECT OR CONSEQUENTIAL DAMAGES WITH RESPECT TO ANY CLAIMS ARISING FROM THE
|
|
* CONTENT OF SUCH FIRMWARE AND/OR THE USE MADE BY CUSTOMERS OF THE CODING
|
|
* INFORMATION CONTAINED HEREIN IN CONNECTION WITH THEIR PRODUCTS.
|
|
*******************************************************************************/
|
|
|
|
/* Includes ------------------------------------------------------------------*/
|
|
#include "stm32f10x.h"
|
|
#include "usb_lib.h"
|
|
#include "usb_conf.h"
|
|
#include "pios_usb_hid_pwr.h"
|
|
#include "pios_usb_hid.h"
|
|
|
|
/* Private typedef -----------------------------------------------------------*/
|
|
/* Private define ------------------------------------------------------------*/
|
|
/* Private macro -------------------------------------------------------------*/
|
|
/* Private variables ---------------------------------------------------------*/
|
|
__IO uint32_t bDeviceState = UNCONNECTED; /* USB device status */
|
|
__IO bool fSuspendEnabled = TRUE; /* true when suspend is possible */
|
|
|
|
struct {
|
|
__IO RESUME_STATE eState;
|
|
__IO uint8_t bESOFcnt;
|
|
} ResumeS;
|
|
|
|
/* Extern variables ----------------------------------------------------------*/
|
|
/* Private function prototypes -----------------------------------------------*/
|
|
/* Extern function prototypes ------------------------------------------------*/
|
|
/* Private functions ---------------------------------------------------------*/
|
|
|
|
/*******************************************************************************
|
|
* Function Name : USB_Cable_Config.
|
|
* Description : Software Connection/Disconnection of USB Cable.
|
|
* Input : NewState: new state.
|
|
* Output : None.
|
|
* Return : None
|
|
*******************************************************************************/
|
|
void USB_Cable_Config(__attribute__((unused)) FunctionalState NewState)
|
|
{
|
|
}
|
|
|
|
/*******************************************************************************
|
|
* Function Name : PowerOn
|
|
* Description :
|
|
* Input : None.
|
|
* Output : None.
|
|
* Return : USB_SUCCESS.
|
|
*******************************************************************************/
|
|
RESULT PowerOn(void)
|
|
{
|
|
#ifndef STM32F10X_CL
|
|
uint16_t wRegVal;
|
|
|
|
/*** cable plugged-in ? ***/
|
|
USB_Cable_Config(ENABLE);
|
|
|
|
/*** CNTR_PWDN = 0 ***/
|
|
wRegVal = CNTR_FRES;
|
|
_SetCNTR(wRegVal);
|
|
|
|
/*** CNTR_FRES = 0 ***/
|
|
wInterrupt_Mask = 0;
|
|
_SetCNTR(wInterrupt_Mask);
|
|
/*** Clear pending interrupts ***/
|
|
_SetISTR(0);
|
|
/*** Set interrupt mask ***/
|
|
wInterrupt_Mask = CNTR_RESETM | CNTR_SUSPM | CNTR_WKUPM;
|
|
_SetCNTR(wInterrupt_Mask);
|
|
#endif /* STM32F10X_CL */
|
|
|
|
return USB_SUCCESS;
|
|
}
|
|
|
|
/*******************************************************************************
|
|
* Function Name : PowerOff
|
|
* Description : handles switch-off conditions
|
|
* Input : None.
|
|
* Output : None.
|
|
* Return : USB_SUCCESS.
|
|
*******************************************************************************/
|
|
RESULT PowerOff()
|
|
{
|
|
#ifndef STM32F10X_CL
|
|
/* disable all ints and force USB reset */
|
|
_SetCNTR(CNTR_FRES);
|
|
/* clear interrupt status register */
|
|
_SetISTR(0);
|
|
/* Disable the Pull-Up */
|
|
USB_Cable_Config(DISABLE);
|
|
/* switch-off device */
|
|
_SetCNTR(CNTR_FRES + CNTR_PDWN);
|
|
#endif /* STM32F10X_CL */
|
|
|
|
/* sw variables reset */
|
|
/* ... */
|
|
|
|
return USB_SUCCESS;
|
|
}
|
|
|
|
/*******************************************************************************
|
|
* Function Name : Enter_LowPowerMode.
|
|
* Description : Power-off system clocks and power while entering suspend mode.
|
|
* Input : None.
|
|
* Output : None.
|
|
* Return : None.
|
|
*******************************************************************************/
|
|
void Enter_LowPowerMode(void)
|
|
{
|
|
/* Set the device state to suspend */
|
|
bDeviceState = SUSPENDED;
|
|
}
|
|
|
|
/*******************************************************************************
|
|
* Function Name : Suspend
|
|
* Description : sets suspend mode operating conditions
|
|
* Input : None.
|
|
* Output : None.
|
|
* Return : USB_SUCCESS.
|
|
*******************************************************************************/
|
|
void Suspend(void)
|
|
{
|
|
#ifndef STM32F10X_CL
|
|
uint16_t wCNTR;
|
|
/* suspend preparation */
|
|
/* ... */
|
|
|
|
/* macrocell enters suspend mode */
|
|
wCNTR = _GetCNTR();
|
|
wCNTR |= CNTR_FSUSP;
|
|
_SetCNTR(wCNTR);
|
|
#endif /* STM32F10X_CL */
|
|
|
|
/* ------------------ ONLY WITH BUS-POWERED DEVICES ---------------------- */
|
|
/* power reduction */
|
|
/* ... on connected devices */
|
|
|
|
#ifndef STM32F10X_CL
|
|
/* force low-power mode in the macrocell */
|
|
wCNTR = _GetCNTR();
|
|
wCNTR |= CNTR_LPMODE;
|
|
_SetCNTR(wCNTR);
|
|
#endif /* STM32F10X_CL */
|
|
|
|
/* switch-off the clocks */
|
|
/* ... */
|
|
Enter_LowPowerMode();
|
|
|
|
}
|
|
|
|
/*******************************************************************************
|
|
* Function Name : Leave_LowPowerMode.
|
|
* Description : Restores system clocks and power while exiting suspend mode.
|
|
* Input : None.
|
|
* Output : None.
|
|
* Return : None.
|
|
*******************************************************************************/
|
|
void Leave_LowPowerMode(void)
|
|
{
|
|
DEVICE_INFO *pInfo = &Device_Info;
|
|
|
|
/* Set the device state to the correct state */
|
|
if (pInfo->Current_Configuration != 0) {
|
|
/* Device configured */
|
|
bDeviceState = CONFIGURED;
|
|
} else {
|
|
bDeviceState = ATTACHED;
|
|
}
|
|
}
|
|
|
|
/*******************************************************************************
|
|
* Function Name : Resume_Init
|
|
* Description : Handles wake-up restoring normal operations
|
|
* Input : None.
|
|
* Output : None.
|
|
* Return : USB_SUCCESS.
|
|
*******************************************************************************/
|
|
void Resume_Init(void)
|
|
{
|
|
#ifndef STM32F10X_CL
|
|
uint16_t wCNTR;
|
|
#endif /* STM32F10X_CL */
|
|
|
|
/* ------------------ ONLY WITH BUS-POWERED DEVICES ---------------------- */
|
|
/* restart the clocks */
|
|
/* ... */
|
|
|
|
#ifndef STM32F10X_CL
|
|
/* CNTR_LPMODE = 0 */
|
|
wCNTR = _GetCNTR();
|
|
wCNTR &= (~CNTR_LPMODE);
|
|
_SetCNTR(wCNTR);
|
|
#endif /* STM32F10X_CL */
|
|
|
|
/* restore full power */
|
|
/* ... on connected devices */
|
|
Leave_LowPowerMode();
|
|
|
|
#ifndef STM32F10X_CL
|
|
/* reset FSUSP bit */
|
|
_SetCNTR(IMR_MSK);
|
|
#endif /* STM32F10X_CL */
|
|
|
|
/* reverse suspend preparation */
|
|
/* ... */
|
|
|
|
}
|
|
|
|
/*******************************************************************************
|
|
* Function Name : Resume
|
|
* Description : This is the state machine handling resume operations and
|
|
* timing sequence. The control is based on the Resume structure
|
|
* variables and on the ESOF interrupt calling this subroutine
|
|
* without changing machine state.
|
|
* Input : a state machine value (RESUME_STATE)
|
|
* RESUME_ESOF doesn't change ResumeS.eState allowing
|
|
* decrementing of the ESOF counter in different states.
|
|
* Output : None.
|
|
* Return : None.
|
|
*******************************************************************************/
|
|
void Resume(RESUME_STATE eResumeSetVal)
|
|
{
|
|
#ifndef STM32F10X_CL
|
|
uint16_t wCNTR;
|
|
#endif /* STM32F10X_CL */
|
|
|
|
if (eResumeSetVal != RESUME_ESOF)
|
|
ResumeS.eState = eResumeSetVal;
|
|
|
|
switch (ResumeS.eState) {
|
|
case RESUME_EXTERNAL:
|
|
Resume_Init();
|
|
ResumeS.eState = RESUME_OFF;
|
|
break;
|
|
case RESUME_INTERNAL:
|
|
Resume_Init();
|
|
ResumeS.eState = RESUME_START;
|
|
break;
|
|
case RESUME_LATER:
|
|
ResumeS.bESOFcnt = 2;
|
|
ResumeS.eState = RESUME_WAIT;
|
|
break;
|
|
case RESUME_WAIT:
|
|
ResumeS.bESOFcnt--;
|
|
if (ResumeS.bESOFcnt == 0)
|
|
ResumeS.eState = RESUME_START;
|
|
break;
|
|
case RESUME_START:
|
|
#ifdef STM32F10X_CL
|
|
OTGD_FS_SetRemoteWakeup();
|
|
#else
|
|
wCNTR = _GetCNTR();
|
|
wCNTR |= CNTR_RESUME;
|
|
_SetCNTR(wCNTR);
|
|
#endif /* STM32F10X_CL */
|
|
ResumeS.eState = RESUME_ON;
|
|
ResumeS.bESOFcnt = 10;
|
|
break;
|
|
case RESUME_ON:
|
|
#ifndef STM32F10X_CL
|
|
ResumeS.bESOFcnt--;
|
|
if (ResumeS.bESOFcnt == 0) {
|
|
#endif /* STM32F10X_CL */
|
|
#ifdef STM32F10X_CL
|
|
OTGD_FS_ResetRemoteWakeup();
|
|
#else
|
|
wCNTR = _GetCNTR();
|
|
wCNTR &= (~CNTR_RESUME);
|
|
_SetCNTR(wCNTR);
|
|
#endif /* STM32F10X_CL */
|
|
ResumeS.eState = RESUME_OFF;
|
|
#ifndef STM32F10X_CL
|
|
}
|
|
#endif /* STM32F10X_CL */
|
|
break;
|
|
case RESUME_OFF:
|
|
case RESUME_ESOF:
|
|
default:
|
|
ResumeS.eState = RESUME_OFF;
|
|
break;
|
|
}
|
|
}
|
|
|
|
/******************* (C) COPYRIGHT 2010 STMicroelectronics *****END OF FILE****/
|