deon/chopstx
1
0
Fork 0
Code Issues Pull Requests Projects Releases Wiki Activity

Add chx_sleep_mode.

Browse Source
This commit is contained in:
NIIBE Yutaka
2017-11-15 17:09:30 +09:00
parent 13926ac05a
commit 941a8f6fbd
4 changed files with 86 additions and 1 deletions
Download Patch File Download Diff File Expand all files Collapse all files

6
ChangeLog
View File

@@ -1,3 +1,9 @@
2017-11-15 NIIBE Yutaka <gniibe@fsij.org>
* chopstx.c (chopstx_conf_idle): Call chx_sleep_mode.
* chopstx-cortex-m.c (chx_sleep_mode): New.
* chopstx-gnu-linux.c (chx_sleep_mode): New.
2017-11-15 NIIBE Yutaka <gniibe@fsij.org>
* example-fsm-55/hh.c (main): Add call to chopstx_conf_idle.

64
chopstx-cortex-m.c
View File

@@ -704,3 +704,67 @@ svc (void)
: /* no output */ : "r" (tp) : "memory");
}
#endif
struct SCB
{
volatile uint32_t CPUID;
volatile uint32_t ICSR;
volatile uint32_t VTOR;
volatile uint32_t AIRCR;
volatile uint32_t SCR;
volatile uint32_t CCR;
volatile uint8_t SHP[12];
volatile uint32_t SHCSR;
volatile uint32_t CFSR;
volatile uint32_t HFSR;
volatile uint32_t DFSR;
volatile uint32_t MMFAR;
volatile uint32_t BFAR;
volatile uint32_t AFSR;
volatile uint32_t PFR[2];
volatile uint32_t DFR;
volatile uint32_t ADR;
volatile uint32_t MMFR[4];
volatile uint32_t ISAR[5];
/* Cortex-M3 has more... */
};
static struct SCB *const SCB = ((struct SCB *)0xE000ED00);
#define SCB_SCR_SLEEPDEEP (1 << 2)
struct PWR
{
volatile uint32_t CR;
volatile uint32_t CSR;
};
static struct PWR *const PWR = ((struct PWR *)0x40007000);
#define PWR_CR_LPDS 0x0001
#define PWR_CR_PDDS 0x0002
#define PWR_CR_CWUF 0x0004
void
chx_sleep_mode (int enable_sleep)
{
if (enable_sleep == 0)
;
else
{
if (enable_sleep == 1)
/* sleep only */
SCB->SCR &= ~SCB_SCR_SLEEPDEEP;
else
{
PWR->CR |= PWR_CR_CWUF;
if (enable_sleep == 2 || enable_sleep == 3)
{
PWR->CR &= ~PWR_CR_PDDS;
if (enable_sleep == 3)
PWR->CR |= PWR_CR_LPDS;
}
else /* enable_sleep == 4 */
PWR->CR |= PWR_CR_PDDS;
SCB->SCR |= SCB_SCR_SLEEPDEEP;
}
}
}

5
chopstx-gnu-linux.c
View File

@@ -342,3 +342,8 @@ chopstx_create_arch (uintptr_t stack_addr, size_t stack_size,
chx_cpu_sched_unlock ();
return tp;
}
void
chx_sleep_mode (int enable_sleep)
{
}

12
chopstx.c
View File

@@ -1481,7 +1481,16 @@ chopstx_setpriority (chopstx_prio_t prio_new)
* chopstx_conf_idle - Configure IDLE thread
* @enable_sleep: Enable sleep on idle or not
*
* If @enable_sleep is true, allow sleep for the idle thread.
* If @enable_sleep is > 0, allow sleep for the idle thread.
*
* Behavior of @enable_sleep >= 1 depends on MCU.
*
* For STM32F103, it's like following.
* 1: Sleep (CPU clock OFF only)
* 2: Stop Wakeup by EXTI (voltage regulator on)
* 3: Stop Wakeup by EXTI (voltage regulator low-power)
* 4: Standby Wakeup by RESET (voltage regulator off)
*
* Return previous value of @enable_sleep.
*/
int
@@ -1492,6 +1501,7 @@ chopstx_conf_idle (int enable_sleep)
chx_spin_lock (&chx_enable_sleep_lock);
r = chx_allow_sleep;
chx_allow_sleep = enable_sleep;
chx_sleep_mode (enable_sleep);
chx_spin_unlock (&chx_enable_sleep_lock);
return r;