I'm searching for a toolbox that will aid in the development of a trajectory optimisation method to perform pose estimation/motion capture of quadruped animals. I have data from multiple cameras and would like to fit a skeletal model to the data. I'm using trajectory optimisation to obtain the pose and dynamics (internal torques and external contact forces) of the animal during locomotion.
I have a solution using custom software -- but it is very slow and hinders the experimentation process.
Would you recommend using Drake for this? If yes, which modules do you recommend I take a look at? If not, what are the drawbacks of trying to use Drake and do you recommend any other software for this?