diff --git a/flight/CopterControl/System/inc/pios_config.h b/flight/CopterControl/System/inc/pios_config.h
index 38a95aaab..f67fbfedc 100644
--- a/flight/CopterControl/System/inc/pios_config.h
+++ b/flight/CopterControl/System/inc/pios_config.h
@@ -74,11 +74,11 @@
 #define AUXUART_ENABLED			0
 #define AUXUART_BAUDRATE		19200
 
-#define PIOS_ACTUATOR_STACK_SIZE        990
-#define PIOS_MANUAL_STACK_SIZE          624
-#define PIOS_SYSTEM_STACK_SIZE          624
-#define PIOS_STABILIZATION_STACK_SIZE   524
-#define PIOS_TELEM_STACK_SIZE           480
+#define PIOS_ACTUATOR_STACK_SIZE       1020
+#define PIOS_MANUAL_STACK_SIZE          644
+#define PIOS_SYSTEM_STACK_SIZE          644
+#define PIOS_STABILIZATION_STACK_SIZE   544
+#define PIOS_TELEM_STACK_SIZE           500
 
 #endif /* PIOS_CONFIG_H */
 /**
diff --git a/flight/PiOS/Boards/STM32103CB_CC_Rev1.h b/flight/PiOS/Boards/STM32103CB_CC_Rev1.h
index 9c327b3f5..29a243c1b 100644
--- a/flight/PiOS/Boards/STM32103CB_CC_Rev1.h
+++ b/flight/PiOS/Boards/STM32103CB_CC_Rev1.h
@@ -95,7 +95,7 @@ TIM4  |  RC In 1  |  Servo 3  |  Servo 2  |  Servo 1
 //------------------------
 // TELEMETRY 
 //------------------------
-#define TELEM_QUEUE_SIZE         2
+#define TELEM_QUEUE_SIZE         20
 
 //------------------------
 // PIOS_LED