"Hi, 
that is funny i am working on same concept ,.. 
So is there an reason why you didnt use any ardupilot ? for control ? 
And did you find an way how do dertemine indoor how far you went in meters ? 
 
hint would be great 
cu 
thomas "