Fix mixtake in I2C probe check

workspace/TS100/Core/BSP/Miniware/BSP.cpp

@@ -1,5 +1,6 @@
 //BSP mapping functions
 
+#include <IRQ.h>
 #include "BSP.h"
 #include "Setup.h"
 #include "history.hpp"
@@ -212,41 +213,6 @@ uint8_t getButtonB() {
 			1 : 0;
 }
 
-/*
- * Catch the IRQ that says that the conversion is done on the temperature
- * readings coming in Once these have come in we can unblock the PID so that it
- * runs again
- */
-void HAL_ADCEx_InjectedConvCpltCallback(ADC_HandleTypeDef *hadc) {
-	BaseType_t xHigherPriorityTaskWoken = pdFALSE;
-	if (hadc == &hadc1) {
-		if (pidTaskNotification) {
-			vTaskNotifyGiveFromISR(pidTaskNotification,
-					&xHigherPriorityTaskWoken);
-			portYIELD_FROM_ISR(xHigherPriorityTaskWoken);
-		}
-	}
-}
-void HAL_I2C_MasterRxCpltCallback(I2C_HandleTypeDef *hi2c __unused) {
-	FRToSI2C::CpltCallback();
-}
-void HAL_I2C_MasterTxCpltCallback(I2C_HandleTypeDef *hi2c __unused) {
-	FRToSI2C::CpltCallback();
-}
-void HAL_I2C_MemTxCpltCallback(I2C_HandleTypeDef *hi2c __unused) {
-	FRToSI2C::CpltCallback();
-}
-void HAL_I2C_ErrorCallback(I2C_HandleTypeDef *hi2c __unused) {
-
-	FRToSI2C::CpltCallback();
-}
-void HAL_I2C_AbortCpltCallback(I2C_HandleTypeDef *hi2c __unused) {
-
-	FRToSI2C::CpltCallback();
-}
-void HAL_I2C_MemRxCpltCallback(I2C_HandleTypeDef *hi2c __unused) {
-	FRToSI2C::CpltCallback();
-}
 void reboot() {
 	NVIC_SystemReset();
 }

workspace/TS100/Core/BSP/Miniware/I2C_Wrapper.cpp

@@ -30,7 +30,7 @@ bool FRToSI2C::Mem_Read(uint16_t DevAddress, uint16_t MemAddress,
 		// RToS is active, run threading
 		// Get the mutex so we can use the I2C port
 		// Wait up to 1 second for the mutex
-		if (xSemaphoreTake(I2CSemaphore, (TickType_t)50) == pdTRUE) {
+		if (xSemaphoreTake(I2CSemaphore, (TickType_t)500) == pdTRUE) {
 #ifdef I2CUSESDMA
 			if (HAL_I2C_Mem_Read(&hi2c1, DevAddress, MemAddress,
 			I2C_MEMADD_SIZE_8BIT, pData, Size, 500) != HAL_OK) {
@@ -78,8 +78,7 @@ void FRToSI2C::Mem_Write(uint16_t DevAddress, uint16_t MemAddress,
 		// RToS is active, run threading
 		// Get the mutex so we can use the I2C port
 		// Wait up to 1 second for the mutex
-		if (xSemaphoreTake(I2CSemaphore, (TickType_t)50) == pdTRUE) {
+		if (xSemaphoreTake(I2CSemaphore, (TickType_t)500) == pdTRUE) {
-#ifdef I2CUSESDMA
 			if (HAL_I2C_Mem_Write(&hi2c1, DevAddress, MemAddress,
 			I2C_MEMADD_SIZE_8BIT, pData, Size, 500) != HAL_OK) {
 
@@ -87,13 +86,7 @@ void FRToSI2C::Mem_Write(uint16_t DevAddress, uint16_t MemAddress,
 				xSemaphoreGive(I2CSemaphore);
 			}
 			xSemaphoreGive(I2CSemaphore);
-#else
+
-			if (HAL_I2C_Mem_Write(&hi2c1, DevAddress, MemAddress, I2C_MEMADD_SIZE_8BIT, pData,
-							Size, 5000) != HAL_OK) {
-			}
-			xSemaphoreGive(I2CSemaphore);
-#endif
-		} else {
 		}
 	}
 
@@ -130,11 +123,9 @@ void FRToSI2C::Transmit(uint16_t DevAddress, uint8_t *pData, uint16_t Size) {
 
 bool FRToSI2C::probe(uint16_t DevAddress) {
 	uint8_t buffer[1];
-	if (Mem_Read(DevAddress, 0,  buffer, 1)) {
+	return HAL_I2C_Mem_Read(&hi2c1, DevAddress, 0x0F, I2C_MEMADD_SIZE_8BIT,
-		//ACK'd
+			buffer, 1, 1000) == HAL_OK;
-		return true;
+
-	}
-	return false;
 }
 
 void FRToSI2C::I2C_Unstick() {

workspace/TS100/Core/BSP/Miniware/IRQ.cpp

@@ -0,0 +1,43 @@
+/*
+ * IRQ.c
+ *
+ *  Created on: 30 May 2020
+ *      Author: Ralim
+ */
+
+#include "IRQ.h"
+/*
+ * Catch the IRQ that says that the conversion is done on the temperature
+ * readings coming in Once these have come in we can unblock the PID so that it
+ * runs again
+ */
+void HAL_ADCEx_InjectedConvCpltCallback(ADC_HandleTypeDef *hadc) {
+	BaseType_t xHigherPriorityTaskWoken = pdFALSE;
+	if (hadc == &hadc1) {
+		if (pidTaskNotification) {
+			vTaskNotifyGiveFromISR(pidTaskNotification,
+					&xHigherPriorityTaskWoken);
+			portYIELD_FROM_ISR(xHigherPriorityTaskWoken);
+		}
+	}
+}
+void HAL_I2C_MasterRxCpltCallback(I2C_HandleTypeDef *hi2c __unused) {
+	FRToSI2C::CpltCallback();
+}
+void HAL_I2C_MasterTxCpltCallback(I2C_HandleTypeDef *hi2c __unused) {
+	FRToSI2C::CpltCallback();
+}
+void HAL_I2C_MemTxCpltCallback(I2C_HandleTypeDef *hi2c __unused) {
+	FRToSI2C::CpltCallback();
+}
+void HAL_I2C_ErrorCallback(I2C_HandleTypeDef *hi2c __unused) {
+
+	FRToSI2C::CpltCallback();
+}
+void HAL_I2C_AbortCpltCallback(I2C_HandleTypeDef *hi2c __unused) {
+
+	FRToSI2C::CpltCallback();
+}
+void HAL_I2C_MemRxCpltCallback(I2C_HandleTypeDef *hi2c __unused) {
+	FRToSI2C::CpltCallback();
+}

workspace/TS100/Core/BSP/Miniware/IRQ.h

@@ -0,0 +1,31 @@
+/*
+ * Irqs.h
+ *
+ *  Created on: 30 May 2020
+ *      Author: Ralim
+ */
+
+#ifndef BSP_MINIWARE_IRQ_H_
+#define BSP_MINIWARE_IRQ_H_
+
+#include "BSP.h"
+#include "stm32f1xx_hal.h"
+#include "I2C_Wrapper.hpp"
+#include "Setup.h"
+#include "main.hpp"
+
+#ifdef __cplusplus
+extern "C" {
+#endif
+void HAL_ADCEx_InjectedConvCpltCallback(ADC_HandleTypeDef *hadc);
+void HAL_I2C_ErrorCallback(I2C_HandleTypeDef *hi2c);
+void HAL_I2C_AbortCpltCallback(I2C_HandleTypeDef *hi2c);
+void HAL_I2C_MasterTxCpltCallback(I2C_HandleTypeDef *hi2c);
+void HAL_I2C_MasterRxCpltCallback(I2C_HandleTypeDef *hi2c);
+void HAL_I2C_MemTxCpltCallback(I2C_HandleTypeDef *hi2c);
+void HAL_I2C_MemRxCpltCallback(I2C_HandleTypeDef *hi2c);
+
+#ifdef __cplusplus
+}
+#endif
+#endif /* BSP_MINIWARE_IRQ_H_ */

workspace/TS100/Core/BSP/Miniware/postRTOS.cpp

@@ -7,7 +7,8 @@
 #include "power.hpp"
 #include "stdlib.h"
 #include "task.h"
-
+#include "I2C_Wrapper.hpp"
 void postRToSInit() {
     // Any after RTos setup
+	FRToSI2C::FRToSInit();
 }

workspace/TS100/Core/Inc/main.hpp

@@ -11,13 +11,6 @@ extern bool settingsWereReset;
 extern "C" {
 #endif
 
-void HAL_ADCEx_InjectedConvCpltCallback(ADC_HandleTypeDef *hadc);
-void HAL_I2C_ErrorCallback(I2C_HandleTypeDef *hi2c);
-void HAL_I2C_AbortCpltCallback(I2C_HandleTypeDef *hi2c);
-void HAL_I2C_MasterTxCpltCallback(I2C_HandleTypeDef *hi2c);
-void HAL_I2C_MasterRxCpltCallback(I2C_HandleTypeDef *hi2c);
-void HAL_I2C_MemTxCpltCallback(I2C_HandleTypeDef *hi2c);
-void HAL_I2C_MemRxCpltCallback(I2C_HandleTypeDef *hi2c);
 void vApplicationStackOverflowHook(xTaskHandle *pxTask,
 		signed portCHAR *pcTaskName);
 

workspace/TS100/Core/Src/main.cpp

@@ -38,11 +38,11 @@ int main(void) {
 	preRToSInit();
 
 	setTipX10Watts(0);  // force tip off
+	resetWatchdog();
 	OLED::initialize();  // start up the LCD
 	OLED::setFont(0);    // default to bigger font
 	// Testing for which accelerometer is mounted
 	resetWatchdog();
-	resetWatchdog();
 	settingsWereReset = restoreSettings();  // load the settings from flash
 	if (MMA8652FC::detect()) {
 		PCBVersion = 1;
@@ -72,11 +72,11 @@ int main(void) {
 			PIDTaskStackSize, PIDTaskBuffer, &PIDTaskControlBlock);
 	PIDTaskHandle = osThreadCreate(osThread(PIDTask), NULL);
 
-	if (PCBVersion < 3) {
 	osThreadStaticDef(MOVTask, startMOVTask, osPriorityNormal, 0,
 			MOVTaskStackSize, MOVTaskBuffer, &MOVTaskControlBlock);
 	MOVTaskHandle = osThreadCreate(osThread(MOVTask), NULL);
-	}
+
+	resetWatchdog();
 
 	/* Start scheduler */
 	osKernelStart();

workspace/TS100/Core/Threads/GUIThread.cpp

@@ -10,9 +10,8 @@ extern "C" {
 #include <MMA8652FC.hpp>
 #include <gui.hpp>
 #include <history.hpp>
-#include <main.hpp>
+#include "main.hpp"
 #include <power.hpp>
-
 #include "../../configuration.h"
 #include "Buttons.hpp"
 #include "LIS2DH12.hpp"
@@ -23,7 +22,7 @@ extern "C" {
 #include "stdlib.h"
 #include "string.h"
 #include "unit.h"
-extern uint8_t PCBVersion;
+
 // File local variables
 extern uint32_t currentTempTargetDegC;
 extern uint8_t accelInit;
@@ -597,7 +596,7 @@ void showDebugMenu(void) {
 
 /* StartGUITask function */
 void startGUITask(void const *argument __unused) {
-    FRToSI2C::FRToSInit();
+
     uint8_t tempWarningState = 0;
     bool buttonLockout = false;
     bool tempOnDisplay = false;

workspace/TS100/Core/Threads/MOVThread.cpp

@@ -23,20 +23,18 @@
 uint8_t accelInit = 0;
 uint32_t lastMovementTime = 0;
 void startMOVTask(void const *argument __unused) {
-    OLED::setRotation(true);
+	OLED::setRotation(systemSettings.OrientationMode & 1);
 	postRToSInit();
 	power_probe();
-    while (pidTaskNotification == 0) osDelay(30);  // Wait for PID to start
-
-    OLED::setRotation(systemSettings.OrientationMode & 1);
 	lastMovementTime = 0;
-    int16_t datax[MOVFilter] = {0};
+	int16_t datax[MOVFilter] = { 0 };
-    int16_t datay[MOVFilter] = {0};
+	int16_t datay[MOVFilter] = { 0 };
-    int16_t dataz[MOVFilter] = {0};
+	int16_t dataz[MOVFilter] = { 0 };
 	uint8_t currentPointer = 0;
 	int16_t tx = 0, ty = 0, tz = 0;
 	int32_t avgx, avgy, avgz;
-    if (systemSettings.sensitivity > 9) systemSettings.sensitivity = 9;
+	if (systemSettings.sensitivity > 9)
+		systemSettings.sensitivity = 9;
 	Orientation rotation = ORIENTATION_FLAT;
 	for (;;) {
 		int32_t threshold = 1500 + (9 * 200);
@@ -54,14 +52,14 @@ void startMOVTask(void const *argument __unused) {
 				OLED::setRotation(rotation == ORIENTATION_LEFT_HAND); // link the data through
 			}
 		}
-        datax[currentPointer] = (int32_t)tx;
+		datax[currentPointer] = (int32_t) tx;
-        datay[currentPointer] = (int32_t)ty;
+		datay[currentPointer] = (int32_t) ty;
-        dataz[currentPointer] = (int32_t)tz;
+		dataz[currentPointer] = (int32_t) tz;
 		if (!accelInit) {
 			for (uint8_t i = currentPointer + 1; i < MOVFilter; i++) {
-                datax[i] = (int32_t)tx;
+				datax[i] = (int32_t) tx;
-                datay[i] = (int32_t)ty;
+				datay[i] = (int32_t) ty;
-                dataz[i] = (int32_t)tz;
+				dataz[i] = (int32_t) tz;
 			}
 			accelInit = 1;
 		}