diff --git a/ROMFS/px4fmu_common/init.d/rcS b/ROMFS/px4fmu_common/init.d/rcS
index 897efd252a..744fbee304 100644
--- a/ROMFS/px4fmu_common/init.d/rcS
+++ b/ROMFS/px4fmu_common/init.d/rcS
@@ -522,6 +522,11 @@ then
 				# Start MAVLink on Wifi (ESP8266 port)
 				mavlink start -r 20000 -m config -b 921600 -d /dev/ttyS0
 			fi
+
+			if ver hwcmp AEROFC_V1
+			then
+				set MAVLINK_F "-r 1200 -d /dev/ttyS4"
+			fi
 		fi
 
 		if ver hwcmp CRAZYFLIE
diff --git a/nuttx-configs/aerofc-v1/include/board.h b/nuttx-configs/aerofc-v1/include/board.h
index 3e6c1630d2..d4473e9555 100644
--- a/nuttx-configs/aerofc-v1/include/board.h
+++ b/nuttx-configs/aerofc-v1/include/board.h
@@ -232,6 +232,9 @@
 #define GPIO_UART4_CTS	0 // unused
 #define GPIO_UART4_RTS	0 // unused
 
+// Mavlink
+// UART5
+
 // Serial console
 #define GPIO_USART6_TX	GPIO_USART6_TX_1
 #define GPIO_USART6_RX	GPIO_USART6_RX_1