diff --git a/libraries/AP_HAL_ChibiOS/Scheduler.h b/libraries/AP_HAL_ChibiOS/Scheduler.h
index 440d5c634c..4e86a5189a 100644
--- a/libraries/AP_HAL_ChibiOS/Scheduler.h
+++ b/libraries/AP_HAL_ChibiOS/Scheduler.h
@@ -23,7 +23,7 @@
 #define CHIBIOS_SCHEDULER_MAX_TIMER_PROCS 8
 
 #define APM_MAIN_PRIORITY       180
-#define APM_TIMER_PRIORITY      178
+#define APM_TIMER_PRIORITY      181
 #define APM_RCIN_PRIORITY       177
 #define APM_UART_PRIORITY        60
 #define APM_STORAGE_PRIORITY     59