I'll try not to tell you forget it.... cause it's harsh....
First of all.... you need funding... for every rotor/ gear/ servo/ tail broken...
Secondly... you need to be good with maths....
As you correctly suggested, such flying machines are good to be based on a mathematical matrix...
that will calculate all four dimensions..... Yup!!! Four..... Cause you will surely need time for calculating the d(ifference)......

you will also need time for speed calculations and so on, cause the bigger the meter of the speed, the
sharpest your correction must be.... Also, see here that you really need filtering... that just wastes more time....
After some theoretical calculations, the real world, must not differ very much.... cause..... it's gonna.... boommmmmmm..... NO GOOD.....
You need also, imagination and courage to make the mistake aka testing......
If you are good, with physics, and advance mathematics then it should be alright.... I assume you know how to code well......
May Zeus be with you..... hehehehehe

Best of luck!!!
Lefteris, Greece