further implemented

fsw/freertos/src/cfe_psp_start.c

@@ -1,3 +1,5 @@
+#include "cmsis_os.h"
+
 #include "cfe_psp.h"
 #include "cfe_psp_config.h"
 
@@ -8,20 +10,20 @@
 #define CFE_PSP_NONVOL_STARTUP_FILE (GLOBAL_CONFIGDATA.CfeConfig->NonvolStartupFile)
 
 
-// TODO: Fully implement after specifying the structure of the reserved memory map
 void CFE_PSP_Restart(uint32 resetType)
 {
 	if (resetType == CFE_PSP_RST_TYPE_POWERON) 
 	{
 		CFE_PSP_ReservedMemoryMap.BootPtr->bsp_reset_type = CFE_PSP_RST_TYPE_POWERON;
 		CFE_PSP_FlushCaches(1, ReservedMemBlock.BlockPtr, ReservedMemBlock.BlockSize);
-		/* TODO: reboot clear */
+
+		NVIC_SystemReset();
 	}
 	else
 	{
 		CFE_PSP_ReservedMemoryMap.BootPtr->bsp_reset_type = CFE_PSP_RST_TYPE_PROCESSOR;
 		CFE_PSP_FlushCaches(1, ReservedMemBlock.BlockPtr, ReservedMemBlock.BlockSize);
-		/* TODO: reboot normal */
+		/* FIXME: reboot without wiping memory */
 	}
 }
 

fsw/freertos/src/cfe_psp_support.c

@@ -16,6 +16,8 @@
  * limitations under the License.
  ************************************************************************/
 
+#include "cmsis_os.h"
+
 #include "target_config.h"
 
 #define CFE_PSP_CPU_ID		(GLOBAL_CONFIGDATA.CpuId)
@@ -26,9 +28,21 @@
 // TODO
 void CFE_PSP_FlushCaches(uint32 type, void *address, uint32 size)
 {
-	/* flush cache of size at address */
-}
+	if (type != 1)
+	{
+		return;
+	}
+	uint32_t startAddr = (uint32_t) address;
+	uint32_t endAddr = startAddr + size;
+
+	startAddr &= ~31;
+	endAddr = (endAddr + 31) & ~31;
 
+	SCB_CleanInvalidateDCache_by_Addr((uint32_t *)startAddr, endAddr - startAddr);
+
+	__DSB();
+	__ISB();
+}
 
 uint32 CFE_PSP_GetProcessorId(void)
 {

fsw/freertos/src/cfe_psp_timer.c

@@ -12,5 +12,6 @@ uint32 CFE_PSP_GetTimerLow32Rollover(void)
 
 void CFE_PSP_Get_Timebase(uint32 *Tbu, uint32 *Tbl)
 {
-	/* TODO */
+	// SysTick is set up in HAL_Init
+	return xTaskGetTickCount;
 }