diff --git a/radio/src/telemetry/mavlink.cpp b/radio/src/telemetry/mavlink.cpp
index a59a2ccd8..33563c21a 100644
--- a/radio/src/telemetry/mavlink.cpp
+++ b/radio/src/telemetry/mavlink.cpp
@@ -553,6 +553,7 @@ static inline void MAVLINK_msg_param_set(uint8_t idx) {
 }
 #endif
 
+__attribute__((unused))
 static inline void MAVLINK_msg_request_data_stream_pack_send(uint8_t req_stream_id, uint16_t req_message_rate,
 				uint8_t start_stop) {
 	mavlink_channel_t chan = MAVLINK_COMM_0;
@@ -560,12 +561,15 @@ static inline void MAVLINK_msg_request_data_stream_pack_send(uint8_t req_stream_
 					start_stop);
 }
 
+
+__attribute__((unused))
 //! \brief old mode switch funtion
 static inline void MAVLINK_msg_set_mode_send(uint8_t mode) {
 	mavlink_channel_t chan = MAVLINK_COMM_0;
 	mavlink_msg_set_mode_send(chan, mavlink_system.sysid, mode, 0);
 }
 
+
 /*!	\brief Telemetry monitoring, calls \link MAVLINK10mspoll.
  *	\todo Reimplemnt \link MAVLINK10mspoll
  *
diff --git a/radio/src/telemetry/mavlink.h b/radio/src/telemetry/mavlink.h
index 02af3a2dc..b99082b04 100644
--- a/radio/src/telemetry/mavlink.h
+++ b/radio/src/telemetry/mavlink.h
@@ -210,13 +210,13 @@ extern Telemetry_Data_t telemetry_data;
 
 
 
-
+#if 0
 extern inline uint8_t MAVLINK_CtrlMode2Action(uint8_t mode) {
 	uint8_t action;
 	
 	return action;
 }
-#if 0
+
 extern inline uint8_t MAVLINK_Action2CtrlMode(uint8_t action) {
 	uint8_t mode = ERROR_NUM_MODES;
 	switch (action) {