You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
95 lines
1.9 KiB
95 lines
1.9 KiB
/* |
|
* Copyright (C) 2016 Kaspar Schleiser <kaspar@schleiser.de> |
|
* |
|
* This file is subject to the terms and conditions of the GNU Lesser |
|
* General Public License v2.1. See the file LICENSE in the top level |
|
* directory for more details. |
|
*/ |
|
|
|
/** |
|
* @ingroup drivers_periph_pm |
|
* @{ |
|
* |
|
* @file |
|
* @brief Platform-independent power management code |
|
* |
|
* @author Kaspar Schleiser <kaspar@schleiser.de> |
|
* |
|
* @} |
|
*/ |
|
|
|
#include "irq.h" |
|
#include "periph/pm.h" |
|
#include "pm_layered.h" |
|
|
|
#define ENABLE_DEBUG (0) |
|
#include "debug.h" |
|
|
|
#ifndef PM_NUM_MODES |
|
#error PM_NUM_MODES must be defined in periph_cpu.h! |
|
#endif |
|
|
|
#ifndef PM_BLOCKER_INITIAL |
|
#define PM_BLOCKER_INITIAL { .val_u32=0x01010101 } |
|
#endif |
|
|
|
/** |
|
* @brief Power Management mode typedef |
|
*/ |
|
typedef union { |
|
uint32_t val_u32; |
|
uint8_t val_u8[PM_NUM_MODES]; |
|
} pm_blocker_t; |
|
|
|
/** |
|
* @brief Global variable for keeping track of blocked modes |
|
*/ |
|
volatile pm_blocker_t pm_blocker = PM_BLOCKER_INITIAL; |
|
|
|
void pm_set_lowest(void) |
|
{ |
|
pm_blocker_t blocker = (pm_blocker_t) pm_blocker; |
|
unsigned mode = PM_NUM_MODES; |
|
while (mode) { |
|
if (blocker.val_u8[mode-1]) { |
|
break; |
|
} |
|
mode--; |
|
} |
|
|
|
/* set lowest mode if blocker is still the same */ |
|
unsigned state = irq_disable(); |
|
if (blocker.val_u32 == pm_blocker.val_u32) { |
|
DEBUG("pm: setting mode %u\n", mode); |
|
pm_set(mode); |
|
} |
|
else { |
|
DEBUG("pm: mode block changed\n"); |
|
} |
|
irq_restore(state); |
|
} |
|
|
|
void pm_block(unsigned mode) |
|
{ |
|
assert(pm_blocker.val_u8[mode] != 255); |
|
|
|
unsigned state = irq_disable(); |
|
pm_blocker.val_u8[mode]++; |
|
irq_restore(state); |
|
} |
|
|
|
void pm_unblock(unsigned mode) |
|
{ |
|
assert(pm_blocker.val_u8[mode] > 0); |
|
|
|
unsigned state = irq_disable(); |
|
pm_blocker.val_u8[mode]--; |
|
irq_restore(state); |
|
} |
|
|
|
void __attribute__((weak)) pm_off(void) |
|
{ |
|
pm_blocker.val_u32 = 0; |
|
pm_set_lowest(); |
|
while(1); |
|
}
|
|
|