"While I dont have a solution to your question, I did find this (in case you havent seen it) from MIT - http://www.gizmag.com/mit-autonomous-indoor-uav/23686/
You might be able to use it as a starting point in your research.
I have a question for you…"