kopia lustrzana https://github.com/DL7AD/pecanpico10
73 wiersze
1.7 KiB
C
73 wiersze
1.7 KiB
C
#include "ch.h"
|
|
#include "hal.h"
|
|
#include "sleep.h"
|
|
#include "padc.h"
|
|
#include "collector.h"
|
|
#include "debug.h"
|
|
#include "padc.h"
|
|
#include "pac1720.h"
|
|
|
|
/**
|
|
* Sleeping method. Returns true if sleeping condition are given.
|
|
*/
|
|
bool p_sleep(const sleep_conf_t *config)
|
|
{
|
|
switch(config->type)
|
|
{
|
|
case SLEEP_WHEN_VBAT_BELOW_THRES:
|
|
return stm32_get_vbat() < config->vbat_thres;
|
|
|
|
case SLEEP_WHEN_VSOL_BELOW_THRES:
|
|
return stm32_get_vsol() < config->vsol_thres;
|
|
|
|
case SLEEP_WHEN_VBAT_ABOVE_THRES:
|
|
return stm32_get_vbat() > config->vbat_thres;
|
|
|
|
case SLEEP_WHEN_VSOL_ABOVE_THRES:
|
|
return stm32_get_vsol() > config->vsol_thres;
|
|
|
|
case SLEEP_WHEN_DISCHARGING:
|
|
case SLEEP_WHEN_CHARGING:
|
|
TRACE_WARN("Sleeping method not implemented");
|
|
return false;
|
|
|
|
case SLEEP_DISABLED:
|
|
return false;
|
|
}
|
|
return false;
|
|
}
|
|
|
|
sysinterval_t waitForTrigger(sysinterval_t prev, sysinterval_t timeout)
|
|
{
|
|
/*switch(config->type)
|
|
{
|
|
case TRIG_NEW_POINT: // Wait for new data point
|
|
waitForNewDataPoint();
|
|
return chVTGetSystemTimeX();
|
|
|
|
case TRIG_TIMEOUT: // Wait for specified timeout
|
|
return chThdSleepUntilWindowed(prev, prev + TIME_S2I(config->timeout));
|
|
|
|
case TRIG_CONTINUOUSLY: // Immediate trigger
|
|
return chVTGetSystemTimeX();
|
|
|
|
case TRIG_ONCE: // No trigger defined
|
|
chThdSleep(TIME_S2I(10));
|
|
}
|
|
|
|
return chVTGetSystemTimeX();*/
|
|
|
|
return chThdSleepUntilWindowed(prev, prev + timeout);
|
|
}
|
|
|
|
void trigger_new_data_point(void)
|
|
{
|
|
uint32_t oldID = getLastDataPoint()->id;
|
|
dataPoint_t *newtp;
|
|
do { // Wait for new serial ID to be deployed
|
|
chThdSleep(TIME_MS2I(100));
|
|
newtp = getLastDataPoint();
|
|
} while(newtp->id == oldID);
|
|
}
|
|
|