From db19c8b410efe1fbcb285643df66e25e59e10b2c Mon Sep 17 00:00:00 2001
From: Andrew Tridgell <tridge@samba.org>
Date: Tue, 14 Jan 2014 12:41:07 +1100
Subject: [PATCH] PX4: start mtd driver on FMUv2

---
 mk/PX4/ROMFS/init.d/rc.APM | 16 +++++++++++++++-
 1 file changed, 15 insertions(+), 1 deletion(-)

diff --git a/mk/PX4/ROMFS/init.d/rc.APM b/mk/PX4/ROMFS/init.d/rc.APM
index 184485987f..6a3788afc2 100644
--- a/mk/PX4/ROMFS/init.d/rc.APM
+++ b/mk/PX4/ROMFS/init.d/rc.APM
@@ -37,7 +37,10 @@ else
 fi
 
 set sketch NONE
-rm /fs/microsd/APM/boot.log
+if rm /fs/microsd/APM/boot.log
+then
+   echo "removed old boot.log"
+fi
 set logfile /fs/microsd/APM/BOOT.LOG
 
 if [ ! -f /bin/ArduPilot ]
@@ -258,6 +261,17 @@ else
    echo "Failed to start rgbled driver" >> $logfile
 fi
 
+if [ $BOARD == FMUv2 ]
+then
+        if mtd start
+        then
+           echo "started mtd driver OK"
+        else
+           echo "failed to start mtd driver"
+           sh /etc/init.d/rc.error           
+        fi
+fi
+
 echo Starting ArduPilot
 echo Starting ArduPilot $deviceA $deviceC $deviceD >> $logfile
 if ArduPilot -d $deviceA -d2 $deviceC -d3 $deviceD start