mirror of
https://github.com/Ralim/IronOS.git
synced 2025-02-26 07:53:55 +00:00
871e8e35c9
Create readme Started commenting the files in english NO Optimisations yet, just trying to get it all working over as is first Using newer STM StdPeriph libs (i think they are newer?)
153 lines
4.8 KiB
C
153 lines
4.8 KiB
C
/******************** (C) COPYRIGHT 2015 e-Design Co., Ltd. ********************
|
|
File Name : USB_pwr.c
|
|
Version : STM32 USB Disk Ver 3.4 Author : MCD Application Team & bure
|
|
*******************************************************************************/
|
|
#include "usb_lib.h"
|
|
#include "usb_conf.h"
|
|
#include "usb_pwr.h"
|
|
|
|
vu32 bDeviceState = UNCONNECTED; // USB device status
|
|
vu8 fSuspendEnabled = TRUE; // true when suspend is possible
|
|
|
|
struct{
|
|
volatile RESUME_STATE eState;
|
|
volatile u8 bESOFcnt;
|
|
} ResumeS;
|
|
|
|
/*******************************************************************************
|
|
PowerOn Return : USB_SUCCESS
|
|
|
|
*******************************************************************************/
|
|
RESULT PowerOn(void)
|
|
{
|
|
u16 wRegVal;
|
|
|
|
/*** 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);
|
|
|
|
return USB_SUCCESS;
|
|
}
|
|
/*******************************************************************************
|
|
PowerOff: handles switch-off conditions Return : USB_SUCCESS
|
|
*******************************************************************************/
|
|
RESULT PowerOff()
|
|
{
|
|
/* 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);
|
|
/* sw variables reset */
|
|
/* ... */
|
|
|
|
return USB_SUCCESS;
|
|
}
|
|
/*******************************************************************************
|
|
Suspend: sets suspend mode operating conditions
|
|
Return : USB_SUCCESS.
|
|
*******************************************************************************/
|
|
void Suspend(void)
|
|
{
|
|
u16 wCNTR;
|
|
/* suspend preparation */
|
|
/* macrocell enters suspend mode */
|
|
wCNTR = _GetCNTR();
|
|
wCNTR |= CNTR_FSUSP;
|
|
_SetCNTR(wCNTR);
|
|
/* ------------------ ONLY WITH BUS-POWERED DEVICES ---------------------- */
|
|
/* power reduction */
|
|
/* ... on connected devices */
|
|
/* force low-power mode in the macrocell */
|
|
wCNTR = _GetCNTR();
|
|
wCNTR |= CNTR_LPMODE;
|
|
_SetCNTR(wCNTR);
|
|
}
|
|
/*******************************************************************************
|
|
Resume_Init: Handles wake-up restoring normal operations
|
|
* Return : USB_SUCCESS.
|
|
*******************************************************************************/
|
|
void Resume_Init(void)
|
|
{
|
|
u16 wCNTR;
|
|
/* ------------------ ONLY WITH BUS-POWERED DEVICES ---------------------- */
|
|
/* restart the clocks */
|
|
/* CNTR_LPMODE = 0 */
|
|
wCNTR = _GetCNTR();
|
|
wCNTR &= (~CNTR_LPMODE);
|
|
_SetCNTR(wCNTR);
|
|
/* restore full power */
|
|
/* ... on connected devices */
|
|
/* reset FSUSP bit */
|
|
_SetCNTR(IMR_MSK);
|
|
/* reverse suspend preparation */
|
|
/* ... */
|
|
}
|
|
/*******************************************************************************
|
|
Resume: 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.
|
|
*******************************************************************************/
|
|
void Resume(RESUME_STATE eResumeSetVal)
|
|
{
|
|
u16 wCNTR;
|
|
|
|
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:
|
|
wCNTR = _GetCNTR();
|
|
wCNTR |= CNTR_RESUME;
|
|
_SetCNTR(wCNTR);
|
|
ResumeS.eState = RESUME_ON;
|
|
ResumeS.bESOFcnt = 10;
|
|
break;
|
|
case RESUME_ON:
|
|
ResumeS.bESOFcnt--;
|
|
if (ResumeS.bESOFcnt == 0){
|
|
wCNTR = _GetCNTR();
|
|
wCNTR &= (~CNTR_RESUME);
|
|
_SetCNTR(wCNTR);
|
|
ResumeS.eState = RESUME_OFF;
|
|
}
|
|
break;
|
|
case RESUME_OFF:
|
|
case RESUME_ESOF:
|
|
default:
|
|
ResumeS.eState = RESUME_OFF;
|
|
break;
|
|
}
|
|
}
|
|
/********************************* END OF FILE ******************************/
|