diff --git a/src/modules/mavlink/mavlink_main.cpp b/src/modules/mavlink/mavlink_main.cpp
index 4a26bf476c..f172dfbeae 100644
--- a/src/modules/mavlink/mavlink_main.cpp
+++ b/src/modules/mavlink/mavlink_main.cpp
@@ -1351,11 +1351,9 @@ Mavlink::task_main(int argc, char *argv[])
 				_mode = MAVLINK_MODE_ONBOARD;
 			} else if (strcmp(optarg, "onboard") == 0) {
 				_mode = MAVLINK_MODE_ONBOARD;
-
-			} else if (strcmp(myoptarg, "osd") == 0) {
+			} else if (strcmp(optarg, "osd") == 0) {
 				_mode = MAVLINK_MODE_OSD;
-
-			} else if (strcmp(myoptarg, "config") == 0) {
+			} else if (strcmp(optarg, "config") == 0) {
 				_mode = MAVLINK_MODE_CONFIG;
 			}