Clean up power calls
This commit is contained in:
20
workspace/TS100/Core/BSP/Miniware/Power.cpp
Normal file
20
workspace/TS100/Core/BSP/Miniware/Power.cpp
Normal file
@@ -0,0 +1,20 @@
|
||||
#include "BSP.h"
|
||||
#include "BSP_Power.h"
|
||||
#include "QC3.h"
|
||||
void power_probe() {
|
||||
// If TS80 probe for QC
|
||||
// If TS100 - noop
|
||||
#ifdef MODEL_TS80
|
||||
startQC(systemSettings.voltageDiv);
|
||||
|
||||
seekQC((systemSettings.cutoutSetting) ? 120 : 90,
|
||||
systemSettings.voltageDiv); // this will move the QC output to the preferred voltage to start with
|
||||
|
||||
#endif
|
||||
}
|
||||
|
||||
void power_check() {
|
||||
#ifdef MODEL_TS80
|
||||
QC_resync();
|
||||
#endif
|
||||
}
|
||||
@@ -9,15 +9,5 @@
|
||||
#include "task.h"
|
||||
|
||||
void postRToSInit() {
|
||||
#ifdef MODEL_TS80
|
||||
startQC(systemSettings.voltageDiv);
|
||||
while (pidTaskNotification == 0) osDelay(30); // Wait for PID to start
|
||||
|
||||
seekQC((systemSettings.cutoutSetting) ? 120 : 90,
|
||||
systemSettings.voltageDiv); // this will move the QC output to the preferred voltage to start with
|
||||
|
||||
#else
|
||||
while (pidTaskNotification == 0) osDelay(30); // Wait for PID to start
|
||||
osDelay(200); // wait for accelerometer to stabilize
|
||||
#endif
|
||||
// Any after RTos setup
|
||||
}
|
||||
|
||||
Reference in New Issue
Block a user