Fix build for MSA
This commit is contained in:
@@ -34,9 +34,10 @@ Orientation MSA301::getOrientation() {
|
|||||||
return Orientation::ORIENTATION_LEFT_HAND;
|
return Orientation::ORIENTATION_LEFT_HAND;
|
||||||
case 96:
|
case 96:
|
||||||
return Orientation::ORIENTATION_RIGHT_HAND;
|
return Orientation::ORIENTATION_RIGHT_HAND;
|
||||||
}
|
default:
|
||||||
return Orientation::ORIENTATION_FLAT;
|
return Orientation::ORIENTATION_FLAT;
|
||||||
}
|
}
|
||||||
|
}
|
||||||
|
|
||||||
void MSA301::getAxisReadings(int16_t &x, int16_t &y, int16_t &z) {
|
void MSA301::getAxisReadings(int16_t &x, int16_t &y, int16_t &z) {
|
||||||
uint8_t temp[6];
|
uint8_t temp[6];
|
||||||
|
|||||||
@@ -394,8 +394,8 @@ static void display_countdown(int sleepThres) {
|
|||||||
* mode is triggered.
|
* mode is triggered.
|
||||||
*/
|
*/
|
||||||
int lastEventTime = lastButtonTime < lastMovementTime ? lastMovementTime : lastButtonTime;
|
int lastEventTime = lastButtonTime < lastMovementTime ? lastMovementTime : lastButtonTime;
|
||||||
int downCount = sleepThres - xTaskGetTickCount() + lastEventTime;
|
TickType_t downCount = sleepThres - xTaskGetTickCount() + lastEventTime;
|
||||||
if (downCount > 99000) {
|
if (downCount > (99 * TICKS_SECOND)) {
|
||||||
OLED::printNumber(downCount / 60000 + 1, 2);
|
OLED::printNumber(downCount / 60000 + 1, 2);
|
||||||
OLED::print(SymbolMinutes);
|
OLED::print(SymbolMinutes);
|
||||||
} else {
|
} else {
|
||||||
@@ -645,10 +645,10 @@ static void gui_solderingMode(uint8_t jumpToSleep) {
|
|||||||
void showDebugMenu(void) {
|
void showDebugMenu(void) {
|
||||||
uint8_t screen = 0;
|
uint8_t screen = 0;
|
||||||
ButtonState b;
|
ButtonState b;
|
||||||
|
OLED::setFont(1); // small font
|
||||||
for (;;) {
|
for (;;) {
|
||||||
OLED::clearScreen(); // Ensure the buffer starts clean
|
OLED::clearScreen(); // Ensure the buffer starts clean
|
||||||
OLED::setCursor(0, 0); // Position the cursor at the 0,0 (top left)
|
OLED::setCursor(0, 0); // Position the cursor at the 0,0 (top left)
|
||||||
OLED::setFont(1); // small font
|
|
||||||
OLED::print(SymbolVersionNumber); // Print version number
|
OLED::print(SymbolVersionNumber); // Print version number
|
||||||
OLED::setCursor(0, 8); // second line
|
OLED::setCursor(0, 8); // second line
|
||||||
OLED::print(DebugMenu[screen]);
|
OLED::print(DebugMenu[screen]);
|
||||||
@@ -717,7 +717,6 @@ void showDebugMenu(void) {
|
|||||||
}
|
}
|
||||||
#endif
|
#endif
|
||||||
if (poweredbyPD) {
|
if (poweredbyPD) {
|
||||||
|
|
||||||
OLED::printNumber(2, 1);
|
OLED::printNumber(2, 1);
|
||||||
} else {
|
} else {
|
||||||
|
|
||||||
|
|||||||
@@ -25,12 +25,11 @@
|
|||||||
uint8_t accelInit = 0;
|
uint8_t accelInit = 0;
|
||||||
TickType_t lastMovementTime = 0;
|
TickType_t lastMovementTime = 0;
|
||||||
void detectAccelerometerVersion() {
|
void detectAccelerometerVersion() {
|
||||||
PCBVersion = 99;
|
DetectedAccelerometerVersion = 99;
|
||||||
#ifdef ACCEL_MMA
|
#ifdef ACCEL_MMA
|
||||||
if (MMA8652FC::detect()) {
|
if (MMA8652FC::detect()) {
|
||||||
|
|
||||||
if (MMA8652FC::initalize()) {
|
if (MMA8652FC::initalize()) {
|
||||||
PCBVersion = 1;
|
DetectedAccelerometerVersion = 1;
|
||||||
}
|
}
|
||||||
} else
|
} else
|
||||||
#endif
|
#endif
|
||||||
@@ -38,7 +37,7 @@ void detectAccelerometerVersion() {
|
|||||||
if (LIS2DH12::detect()) {
|
if (LIS2DH12::detect()) {
|
||||||
// Setup the ST Accelerometer
|
// Setup the ST Accelerometer
|
||||||
if (LIS2DH12::initalize()) {
|
if (LIS2DH12::initalize()) {
|
||||||
PCBVersion = 2;
|
DetectedAccelerometerVersion = 2;
|
||||||
}
|
}
|
||||||
} else
|
} else
|
||||||
#endif
|
#endif
|
||||||
@@ -46,7 +45,7 @@ void detectAccelerometerVersion() {
|
|||||||
if (BMA223::detect()) {
|
if (BMA223::detect()) {
|
||||||
// Setup the ST Accelerometer
|
// Setup the ST Accelerometer
|
||||||
if (BMA223::initalize()) {
|
if (BMA223::initalize()) {
|
||||||
PCBVersion = 3;
|
DetectedAccelerometerVersion = 3;
|
||||||
}
|
}
|
||||||
} else
|
} else
|
||||||
#endif
|
#endif
|
||||||
@@ -54,7 +53,7 @@ void detectAccelerometerVersion() {
|
|||||||
if (MSA301::detect()) {
|
if (MSA301::detect()) {
|
||||||
// Setup the MSA301 Accelerometer
|
// Setup the MSA301 Accelerometer
|
||||||
if (MSA301::initalize()) {
|
if (MSA301::initalize()) {
|
||||||
PCBVersion = 4;
|
DetectedAccelerometerVersion = 4;
|
||||||
}
|
}
|
||||||
} else
|
} else
|
||||||
#endif
|
#endif
|
||||||
@@ -63,8 +62,7 @@ void detectAccelerometerVersion() {
|
|||||||
systemSettings.sensitivity = 0;
|
systemSettings.sensitivity = 0;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
inline void readAccelerometer(int16_t &tx, int16_t &ty, int16_t &tz,
|
inline void readAccelerometer(int16_t &tx, int16_t &ty, int16_t &tz, Orientation &rotation) {
|
||||||
Orientation &rotation) {
|
|
||||||
#ifdef ACCEL_LIS
|
#ifdef ACCEL_LIS
|
||||||
if (DetectedAccelerometerVersion == 2) {
|
if (DetectedAccelerometerVersion == 2) {
|
||||||
LIS2DH12::getAxisReadings(tx, ty, tz);
|
LIS2DH12::getAxisReadings(tx, ty, tz);
|
||||||
@@ -84,7 +82,7 @@ inline void readAccelerometer(int16_t &tx, int16_t &ty, int16_t &tz,
|
|||||||
} else
|
} else
|
||||||
#endif
|
#endif
|
||||||
#ifdef ACCEL_MSA
|
#ifdef ACCEL_MSA
|
||||||
if (PCBVersion == 3) {
|
if (DetectedAccelerometerVersion == 4) {
|
||||||
MSA301::getAxisReadings(tx, ty, tz);
|
MSA301::getAxisReadings(tx, ty, tz);
|
||||||
rotation = MSA301::getOrientation();
|
rotation = MSA301::getOrientation();
|
||||||
} else
|
} else
|
||||||
@@ -96,7 +94,7 @@ inline void readAccelerometer(int16_t &tx, int16_t &ty, int16_t &tz,
|
|||||||
void startMOVTask(void const *argument __unused) {
|
void startMOVTask(void const *argument __unused) {
|
||||||
postRToSInit();
|
postRToSInit();
|
||||||
detectAccelerometerVersion();
|
detectAccelerometerVersion();
|
||||||
osDelay(50); // wait ~50ms for setup of accel to finalise
|
osDelay(TICKS_100MS / 2); // wait ~50ms for setup of accel to finalise
|
||||||
lastMovementTime = 0;
|
lastMovementTime = 0;
|
||||||
// Mask 2 seconds if we are in autostart so that if user is plugging in and
|
// Mask 2 seconds if we are in autostart so that if user is plugging in and
|
||||||
// then putting in stand it doesnt wake instantly
|
// then putting in stand it doesnt wake instantly
|
||||||
@@ -118,8 +116,7 @@ void startMOVTask(void const *argument __unused) {
|
|||||||
readAccelerometer(tx, ty, tz, rotation);
|
readAccelerometer(tx, ty, tz, rotation);
|
||||||
if (systemSettings.OrientationMode == 2) {
|
if (systemSettings.OrientationMode == 2) {
|
||||||
if (rotation != ORIENTATION_FLAT) {
|
if (rotation != ORIENTATION_FLAT) {
|
||||||
OLED::setRotation(rotation ==
|
OLED::setRotation(rotation == ORIENTATION_LEFT_HAND); // link the data through
|
||||||
ORIENTATION_LEFT_HAND); // link the data through
|
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
datax[currentPointer] = (int32_t) tx;
|
datax[currentPointer] = (int32_t) tx;
|
||||||
@@ -155,7 +152,7 @@ void startMOVTask(void const *argument __unused) {
|
|||||||
lastMovementTime = xTaskGetTickCount();
|
lastMovementTime = xTaskGetTickCount();
|
||||||
}
|
}
|
||||||
|
|
||||||
osDelay(100); // Slow down update rate
|
osDelay(TICKS_100MS); // Slow down update rate
|
||||||
power_check();
|
power_check();
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|||||||
Reference in New Issue
Block a user