I would like to know how to transform a setpoint to inputs for the motors of a quadcopter. I would like a function like that:
def goto(x, y, z):
# ...
# Magic happens here
# ...
return [thrust1, thrust2, thrust3, thrust4]
I can't seem to find good documentation on how to do that so my research keywords must be lacking something. If you could point me to some good resources I would be glad to see them.