Index: trunk/firmware/App/CubeMX/Appli/Core/Inc/stm32n6xx_hal_conf.h
===================================================================
--- trunk/firmware/App/CubeMX/Appli/Core/Inc/stm32n6xx_hal_conf.h	(revision 28)
+++ trunk/firmware/App/CubeMX/Appli/Core/Inc/stm32n6xx_hal_conf.h	(revision 29)
@@ -163,5 +163,5 @@
   */
 #define  VDD_VALUE                  3300UL /*!< Value of VDD in mv */
-#define  TICK_INT_PRIORITY          15U  /*!< tick interrupt priority (lowest by default) */
+#define  TICK_INT_PRIORITY          0U  /*!< tick interrupt priority */
 #define  USE_RTOS                   0U
 
Index: trunk/firmware/App/CubeMX/Appli/Core/Inc/stm32n6xx_it.h
===================================================================
--- trunk/firmware/App/CubeMX/Appli/Core/Inc/stm32n6xx_it.h	(revision 28)
+++ trunk/firmware/App/CubeMX/Appli/Core/Inc/stm32n6xx_it.h	(revision 29)
@@ -53,8 +53,5 @@
 void UsageFault_Handler(void);
 void SecureFault_Handler(void);
-void SVC_Handler(void);
 void DebugMon_Handler(void);
-void PendSV_Handler(void);
-void SysTick_Handler(void);
 /* USER CODE BEGIN EFP */
 
Index: trunk/firmware/App/CubeMX/Appli/Core/Src/main.c
===================================================================
--- trunk/firmware/App/CubeMX/Appli/Core/Src/main.c	(revision 28)
+++ trunk/firmware/App/CubeMX/Appli/Core/Src/main.c	(revision 29)
@@ -19,4 +19,5 @@
 /* Includes ------------------------------------------------------------------*/
 #include "main.h"
+#include "app_freertos.h"
 #include "bsec.h"
 #include "gpio.h"
@@ -113,12 +114,18 @@
   /* USER CODE END 2 */
 
+  /* Init scheduler */
+  osKernelInitialize();
+  /* Call init function for freertos objects (in app_freertos.c) */
+  MX_FREERTOS_Init();
+
+  /* Start scheduler */
+  osKernelStart();
+
+  /* We should never get here as control is now taken by the scheduler */
+
   /* Infinite loop */
   /* USER CODE BEGIN WHILE */
   while (1)
   {
-
-	HAL_GPIO_TogglePin(LED_GREEN_GPIO_Port, LED_GREEN_Pin);
-	HAL_Delay(500U);
-	printf("Programm is running at %u MHz\n", SystemCoreClock / 1000000U);
     /* USER CODE END WHILE */
 
Index: trunk/firmware/App/CubeMX/Appli/Core/Src/stm32n6xx_it.c
===================================================================
--- trunk/firmware/App/CubeMX/Appli/Core/Src/stm32n6xx_it.c	(revision 28)
+++ trunk/firmware/App/CubeMX/Appli/Core/Src/stm32n6xx_it.c	(revision 29)
@@ -155,17 +155,4 @@
 
 /**
-  * @brief This function handles System service call via SWI instruction.
-  */
-void SVC_Handler(void)
-{
-  /* USER CODE BEGIN SVCall_IRQn 0 */
-
-  /* USER CODE END SVCall_IRQn 0 */
-  /* USER CODE BEGIN SVCall_IRQn 1 */
-
-  /* USER CODE END SVCall_IRQn 1 */
-}
-
-/**
   * @brief This function handles Debug monitor.
   */
@@ -180,31 +167,4 @@
 }
 
-/**
-  * @brief This function handles Pendable request for system service.
-  */
-void PendSV_Handler(void)
-{
-  /* USER CODE BEGIN PendSV_IRQn 0 */
-
-  /* USER CODE END PendSV_IRQn 0 */
-  /* USER CODE BEGIN PendSV_IRQn 1 */
-
-  /* USER CODE END PendSV_IRQn 1 */
-}
-
-/**
-  * @brief This function handles System tick timer.
-  */
-void SysTick_Handler(void)
-{
-  /* USER CODE BEGIN SysTick_IRQn 0 */
-
-  /* USER CODE END SysTick_IRQn 0 */
-  HAL_IncTick();
-  /* USER CODE BEGIN SysTick_IRQn 1 */
-
-  /* USER CODE END SysTick_IRQn 1 */
-}
-
 /******************************************************************************/
 /* STM32N6xx Peripheral Interrupt Handlers                                    */