kopia lustrzana https://github.com/DL7AD/pecanpico9
80 wiersze
1.8 KiB
C
80 wiersze
1.8 KiB
C
#include "ch.h"
|
|
#include "hal.h"
|
|
#include "sleep.h"
|
|
#include "padc.h"
|
|
#include "tracking.h"
|
|
#include "debug.h"
|
|
#include "padc.h"
|
|
|
|
/**
|
|
* Sleeping method. Returns true if sleeping condition are given.
|
|
*/
|
|
bool p_sleep(const sleep_config_t *config)
|
|
{
|
|
switch(config->type)
|
|
{
|
|
case SLEEP_WHEN_VBAT_BELOW_THRES:
|
|
return getBatteryVoltageMV() < config->vbat_thres;
|
|
|
|
case SLEEP_WHEN_VSOL_BELOW_THRES:
|
|
return getSolarVoltageMV() < config->vsol_thres;
|
|
|
|
case SLEEP_WHEN_VBAT_ABOVE_THRES:
|
|
return getBatteryVoltageMV() > config->vbat_thres;
|
|
|
|
case SLEEP_WHEN_VSOL_ABOVE_THRES:
|
|
return getSolarVoltageMV() > config->vsol_thres;
|
|
|
|
case SLEEP_WHEN_DISCHARGING:
|
|
case SLEEP_WHEN_CHARGING:
|
|
case SLEEP_WHEN_INSIDE_ITU1:
|
|
case SLEEP_WHEN_INSIDE_ITU2:
|
|
case SLEEP_WHEN_INSIDE_ITU3:
|
|
TRACE_WARN("Sleeping method not implemented");
|
|
return false;
|
|
|
|
case SLEEP_DISABLED:
|
|
return false;
|
|
}
|
|
return false;
|
|
}
|
|
|
|
systime_t waitForTrigger(systime_t prev, trigger_config_t *config)
|
|
{
|
|
switch(config->type)
|
|
{
|
|
case TRIG_EVENT: // Wait for new tracking point
|
|
switch(config->event)
|
|
{
|
|
case EVENT_NEW_POINT:
|
|
waitForNewTrackPoint();
|
|
return chVTGetSystemTimeX();
|
|
|
|
case NO_EVENT: // No event defined
|
|
while(1); // Assert
|
|
}
|
|
|
|
case TRIG_TIMEOUT: // Wait for specified timeout
|
|
return chThdSleepUntilWindowed(prev, prev + S2ST(config->timeout));
|
|
|
|
case TRIG_CONTINOUSLY: // Immediate trigger
|
|
return chVTGetSystemTimeX();
|
|
|
|
case TRIG_ONCE: // No trigger defined
|
|
while(1); // Assert
|
|
}
|
|
|
|
return chVTGetSystemTimeX();
|
|
}
|
|
|
|
void trigger_new_tracking_point(void)
|
|
{
|
|
uint32_t oldID = getLastTrackPoint()->id;
|
|
trackPoint_t *newtp;
|
|
do { // Wait for new serial ID to be deployed
|
|
chThdSleepMilliseconds(100);
|
|
newtp = getLastTrackPoint();
|
|
} while(newtp->id == oldID);
|
|
}
|
|
|